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INTRODUCTION 


Operational experience has shown that there is a definite 
need for a new, or at least improved, method for control of 
a near surface submarine. 

"Near surface" generally refers to a submarine which is 
close enough to the surface to be affected by surface waves. 

The purpose of this paper was to devise a depth and pitch 
controller that could improve the sea state capability and 
attain more accurate depth control. In order to decide on 
the proper control strategy, gaining some knowledge of the 
nature of the near surface problem was required. 

In Chapter I, some of the reasons for a submarine to be 
near surface are listed. This is followed by a section pre- 
senting elements of wave theory. The next section then con- 
Sigers the effects of the surface excitation, on the submarine. 
Due to these excitations the submarine operating in the near 
surface environment may be deflected far enough from its 
ordered trajectory to cause position saturation of the for- 
ward planes. The resulting situation is essentially a stern 
planes only control system. This configuration may be unstable. 

To prevent serious problems in this area, the controller 
must be able to perform the following functions: 

1. Identification of plant dynamics. 

feeeeverUaeron Of present position in relation to an opti- 
mum defined and action to drive the system toward the optimum 


Bbyemocgtrrtcatiem Of Controller parameters. 
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Closed loop optimization is used for plants which exhibit 
substantial changes in their dynamic characteristics and where 
random disturbances may have considerable influence on the 
plant state. 

Aiming in that direction, two control systems were 
designed. The one is based on stern planes only control and 
memoresented in Chapter Il. The other is based on having both 
planes available and is presented in Chapter III, in three 
eumehntly different forms. 

The two separate controllers were designed using optimal 
eem@urol theory and their combination led to a configuration 
Capable of improving system performance. The submarine was 
subjected to step and pulse forces and the controller tested 
by simulation on the computer. In Chapter IV, the new scheme 
of controller is introduced and the results of the test are 
presented and analyzed. In Chapter V, further investigation 
of the combined scheme was attempted in an effort to better 
Maigdemstand its function and test the generality of its 
parameters. 

Conclusions by the author conlude the main body of the 
paper. However,seven Appendices are included. Appendix A 
describes the linearization process of equations of motion. 
In Appendix B a derivation of equations of motion from first 
principles is repeated from Ref. 9. A method for relating 
classical feedback to optimal theory is presented in Appendix 
C and a simplified trim analysis in Appendix D. In Appendix 


E,computer programs are describded,setting limits on values 
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of parameters in the combined controller of Chapter IV. Lastly, 
in Appendix F the equations of motion for a submarine in six 
degrees of freedom are repeated from Ref.1 and in Appendix G 


all drawings are kept. 
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ie linea SURFACE PROBLEM 


PeeeitoolLONs OF NEAR SURFACE SUBMARINES 

Knowledge of the reason for a submarine to be near surface 
helps us to gain some insight into control requirements. Some 
noteworthy operations that a near surface submarine in straight 
motion iS expected to be capable of are: 

1. Periscope depth for navigational aiding observations. 

2. Pretorpedo run optical sightings. 

eee Transmission. 

4, Missile launching. 

The demand for each one in a combat environment varies and 
Satisfactory operation is directly connected with relative 
convenience tn choosing speed, particular course with respect 
to the direction of prevailing seas and accepting limits on 
pitch and heave amplitudes. 

The near surface submarine cannot neglect the effects of 
Surface waves. Furthermore, the problem is compounded in 
comparison with that encountered by the surface ship, since 
the operator cannot visually detect the approaching 
disturbance. 

maeeou ese anding characteristic of the open ocean is its 
irregularity. The irregular sea can be described by statis- 
tical mathematics on the basis of the assumption that a large 
number of regular waves having different lengths, directions 
and amplitudes are superimposed. Also the irregular motions 


of a ship in a seaway can be described as the superposition 


47 





of the responses of the ship to all the wave components of 


the seaway. 


B. WAVE THEORY 

In the theory of surface waves, simple two-dimensional 
Peiea are Considered, which can be described completely by 
the motions, pressures, and so on, in any plane perpendicular 
to the crest lines. It 1S assumed that (a) the crests are 
straight, infinitely long, parallel and equally spaced and 
that wave heights are constant, (b) water has zero viscosity 
and 1S incompressible. 

To facilitate the theoretical treatment of ship motions 
in regular waves and the use of the statistical approach to 
the study of behavior in actual sea states, the simple har- 
monic (Sinusoidal) wave was introduced. 

The surface wave is the visible manifestation of pressure 
changes and water particle motions, affecting the entire 
meay OL fluid, theoretically to infinite depth. 

In Fig. I-l, the parameters and properties applicable for 
a Sinusoidal wave on the free surface are displayed. 
$, the velocity potential is defined as a function whose nega- 
tive derivatives yield the velocity components of the fluid, 
and from this, all of the desired wave characteristics can be 
derived. 

For a two-dimensional wave in any depth of water 


‘ | 
b= Te Vw Sos RGBHA) gin u(x - Wt) 
sinh Kh 


te) 





where 


xX = horizontal coordinate, positive in the direction of wave 
propagation. 

Z = vertical coordinate, positive downward. 

(a = surface wave amplitude 

Lw = wave length 

h = depth of water 

k = wave number 2TT/Lw 


Vw = wave velocity 
t = time. 


For the case of deep water, the ratio 
«(-2+h) -~K(-ZLth } 


cosh KGCZth)  _ € r © approaches @** 





Seana Kh am KR > aa 
and then $ =%QWwé Sin u(x -Vot) 
Then Ue =U = horizontal component of water velocity 
z = —K fa Vw a cos k(x -Vert ) 
-U , , 
aa =w = vertical component of water velocity 


= ene a Glink (x —\wt ) 


In deep water all particles describe circular paths having 
aca) J. om at the surface and decreasing with depth in propor- 
Wee 
meron to © 
2 3 . 
It can be shown that Vw = = tanh Kh which defines the 

the velocity of wave in any depth. In deep water Vat 9 = 2% 

7 < rT 


For many problems, the most important aspect of waves is the 


distribution of pressure below the surface. 


49 





The elevation at lines of equal pressure in a wave 


relative to the still water pressure lines is shown to be 


SOS 


deep water Ce Nes say (x ere 


EZ 
Since C decreases as Z increases, the contours of equal 


pressure are attenuated with depth. 
To obtain the surface wave profile, z is taken egual to 
zero. Then 
So Sale COS K(x a | 
= ‘lo cos(ux-wt) where we 2 BV ae 


Most of the characteristics of the simple harmonic wave-- 
except the precise profile--are the same as those of the more 
exact wave formulation. 

The contours at constant pressure that have been presented 
also indicate the increase or decrease in pressure relative 
memset ll! water at any point in terms of depth or head. That 
S'S = P-9 (2-9) and in deep water = 9g72~Gapgé” cos(kx-at) : 
z should be measured to the center of the circular path de- 
scribed by the particle at the point of question. 

Application of the formula shows that under the crest the 
pressures are decreased and under the hollow are increased. 

The energy ina train of regular waves consists of kin- 
etic energy associated with the orbital motion of water 
particles and potential energy resulting from the change of 


water level in wave hollows and crests. 





It can be shown that for a simple cosine wave Be wave 
energy is half potential and half kinetic when averaged over 
a wavelength. The total energy is: 

= 09 Sa lw or if the average energy per unit 
area of surface 1s considered, 
ee ‘9 o9%e 

Stokes and others formulated the hydrodynamic theory of 
waves Of finite amplitude. It corresponds with the observed 
fact that actual waves have sharper crests and flatter 
hollows from the simple coSine wave. The approximate result 
is that the surface profile simple cosine curve is modified 
by a harmonic which is half the length of the fundamental. 
This formulation leads to a limiting wave height from crest 
to trough of 0.14Lw or about 1/7Lw. Real waves will break 
as this height is approached. 
meee ne lORS AFFECTING THE CONTROL OF THE NEAR SURFACE 

SUBMARINE 

The forces on a submerged body may be expressed as the 
integral of the pressure taken over the surface of the body. 
Poreeecne assumpecrons already made (ideal fluid, etc.), 

p= 2 ee +g \V"rQr 
The last term above is connected with the contours of constant 
weecssure. From ia e"'cos(Kx-wt) 
T(2)= Ja:€**, (Jez Gaurfoce) 
it is seen for example, that for a submarine mean depth of 


50 ft. there can still be a significant wave amplitude, 


especially in moderate or high sea states. The problem 


a 





examined as one of hydrostatics gives Fis = -D QN 

where V is the volume of the body and K Pomel sun meayvector 
in the Z direction. Ideally, this passage of a pure 
pressure wave without the accompanying particles velocity 
memecreate essentially no force, since the integral of the 
pressure would not change but remain constant. 

Next there 1S a component of the pressure equation which 
results in the submarine being sucked towards the surface. 
Part of this force is usually referred to as a venturi effect, 
although the last 1S applicable for rigid boundaries and 
steady flow. 

Assuming infinite depth beneath the submarine, there will 
be no constriction of flow around the lower half of the boat. 
Assuming also that the submarine is in a uniform flow field 
with no disturbance, there will be a slight reduction in the 
cross sectional area of flow around the upper half, resulting 
in a higher velocity and thus a lower pressure. 

The reduction in cross sectional area is lessened due 
to the nonrigidity of the boundaries and the wave that the 
Submarine will create on the surface. In reality, the water 
particles, due to existing surface irregularities, will have 
orbital velocities, another discrepancy of the venturi effect 
steady flow assumption. 

Consideration of a regular sinusoidal component of the 
irregular seaway shows that the velocities of the orbital 
particles increase the magnitude of the ye term in the pres- 


Sure equation. So: 
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Vretative = Vshia + Uo cos (Kx-wrt ) 
= Yship + Uo COL re ) ahete € 1 AY bUTAYY 


aoa: -KX Zo 
and on Sa ve (eS = Usut{rax. -C 


Squaring and averaging over time 


* 4 = EeKzZo 
Vee = Vshinp + \ 9 WU gut}. x OC 


This effect coupled with the previously mentioned venturi 
effect can create as much as ten to twenty tons of lift ona 
submarine. 

Provided that the sea state remains unchanged, this 1S a 
time averaged force which remains relatively constant in time. 
Even if the essential irregularity of the sea has been recog- 
nized, it 1s a fact that over a wide area and often for a 
period of several hours, the sea may maintain a characteristic 
Meeecrance which defies precise description in terms of aver- 
age or typical wavelength and height but which nevertheless 
1s constant or steady. At other times or vlaces, the sea will 
be quite different and yet there will again be a characteristic 
appearance. These observations suggested the possibility of 
statistical description of the sea and this was found to be 
PPrieemicas holes Iie Stochastic case can be modeled using 
energy density analysis. The spectrum can provide a mean 
value for the frequency and the wave height. The expected 
Hergat and Lrequency Can be combined to form an average or 
expected wave. This wave can be used to predict the average 
suck due to particle velocities. 

BeenmenecoUneering tials force, the normally stable sub- 


marine becomes unstable and seeks a new equilibrium position 
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by ascending to the surface unless proper precautions are 
taken to prevent "broaching." 

There are basically two ways to offset suck. Adding 
ballast presents the difficulty in determining the proper 
amount for various sea states without making the submarine 
dangerously heavy and sluggish. Using an angle on the sail 
planes to create a downward force presents the problem of 
reduction of control authority, saturation of planes and even 
losing the downward force if the orbital particle velocity 
is such that the angle of attack on the planes is reduced to 
zero. In addition, the particles also induce time dependent 
forces and moments, pitch and heave in particular. 

In Ref. 2, a qualitative example of the happenings as a 
Submarine passes under a regular sinusoidal wave is given. 
The additional VdbAx term in the pressure equation is 
usually neglected. 

An overall survey of the excitations experienced by the 
near surface submarine reveals that they may be broken into 
two basic categories: The first is a d.c. component in the 
form of a suck and the second is an a.c. component which is a 
combination of the various oscillatory forces. When the body 
is subjected to a stochastic seaway, accurate simulation and 
prediction becomes quite involved if not impossible. For a 
submarine under a seaway, the following must be noticed also: 

1. While at great depths, some of the partial derivatives 
are intuitively zero, Z, for instance. Near the surface, the 


Z force varies with depth even in calm seas. The mere 


ba 





presence of £4 alone is sufficient to make the system unstable 
in the vertical plane. 


2. Under a seaway, 


the frequencies of heave and pitch 


Tomeieoe 1centical to those at the encountered excitation. 


Then 
Zexcit = Page 017) (Wet + é 


| (we = frequency of eqcountert) 
Mexcit = W"\ max COs(Wet 7 ey) 
for a regular crested wave. 


When a stochastic excitation is 
introduced and 


assuming linear superposition, 
rf 

a a at Sin (weil + Er) 
L=4 
ae 


wy exe 


M exer a Be a cos(weil+ ea 
Mode? tests yvoevueal os 
t e : X), 


= constant 
yas 
(TV, CO ais ao 
and o 
Leccit = q ee A Sal coe + 2} 
ve 
Mexetl = Z& 


- 
- 


om 
j— 


C94 a Coes Cadet + €1) 


These infinite sums are impossible to work, so they have 
to be replaced, if simplification is desired, by some known 


frequency and wave height statistical averages for the exam- 
ined sea state. 





Peotone. Oso ONu. DEPTH AND PITCH CONTROL SYSTEM 


In order to keep the simulated stern planes only submarine 
on ordered depth and pitch in the presence of disturbances and 
to effect depth changes, a depth and pitch controller is 
designed. 

Figure II-1 illustrates the assumed structure for the con- 
eeobler Optimal design. The application of the optimal control 
1s very well served by the linearization of the equations of 
MmeeLzon. For motions in the vertical plane, roll, pitch, heave 
and surge are applicable. The method reduces the problem to 
four equations. 

For a completely submerged submarine, the effects of surge 
are small enough to be neglected and roll is not considered. 
For a submarine near surface, the problem of roll is worthy of 
an entire paper by itself. To simplify matters, it was neg- 
lected. For a submarine in head or following seas this is a 
very valid step. The state vector for the controller design 


i 
was therefore x _(5 
= 


© 


7 


and the model for determining controller gains 


5 a Sul fa] 
ke = O Raz O Ag 1 oe Bik 0 ¢ 
Oo Oo OC A © 
Oo Pus O A\Q3 | |, OAR 





Details on linearization of the equations of motion are 


given in Appendix A. 
Lord 


Oo Hore Command iImpucs, then for 
Gord 
@; 


Using xr = 


Ti eaeeecctEUrOattons x Can De replaced by E, the state error 
vector and the problem solved as a linear regulator one, with 
states and control unbounded. 


moe cost funcelon to be minimized will be 


aa 
it 2. 
Wea inj (eee+T a] where 
E O O O 
OS 
O A O © 
ekg GC 
O O D O 
O O 0 B 


Forming the Hamiltonian 


i 
FHo= jp EQEsIRUR +P AEr BU 


Necessary conditions for optimality are: 


OO 


Ss oe 
Uh 2AE+@uU 
UE 


[7% 


and ~) i cen ie QR O =O which gives 


* | TF + 

E ey aoe, © = | 
ee ee x will finally give 
i ee | LP 


r= osap=-4%RB KRIE 
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Bemcan be shown that the matrix K satisfies the matrix differ- 


ential equation 
K(H)=-“KA-BK-Q+EKB IQ BK 


wiea the boundary conditions: 


Mer) = © Note that K is symmetric. 


omea plane complecely controllable, with A, B, R and Q 
constant matrices, K(t4) —» K (a constant matrix) as t%—-~~7~< 
That is for an infinite duration process, the optimal control 
1s stationary. From a practical point of view it 1s feasible 
a some cases, to use the fixed control law even for processes 
femeetatte duration. Then the K matrix can be determined also 


by solving the nonlinear algebraic equations c=) ; 


-4 T 


O = -KA-A'K-Q+ KBR BK 


Using the method followed in Ref. l. 


Ki Kar Kar Kaa ne ao Ca Kas 
ig Kaa (Ka K4Q pera kag *3Q Kaa! 
KS ‘ ; ° ‘ f= | 

Kd 93 “ay K43 ena ea 733, Ka 3 | 

| 4 14 a4 ay Ky 4 | , iy Kq4 Ka ss 
Oo Kia + Aya Kore Kay Arg -UKir Rar Kay ekare Age Kas 
~ mrS FIT EAT EKYQAI9 —-UKig Aas Kaq+ks9 Ag Kag 
(eae fo) “13 4+Ars KQ3 +¥43R12 -UKiZ Agi kgs +K334099 Kas 
© Mig + Ars KQ4 + B44 AQ -OKI4 Agi kay +K3h £A22 Kady 
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y 
/ 


@ a = 
Kae Eig Aus Ki4 AQ — KQy +A KQ94k94 AQ dara Kage Kay PiQ May +AU had + Yn AQ - 
le cS —-U Kal 

| 


AQ} K4V+K934A99K34 Agi 449+ K43+Aa2 " 


=U Fi -uka 


— +ki3 + Kiy Aaa Aq Ka9 +K934A29 k24 


Olek ouer 1Q Kay ee 
KB = 4 4KQ9 $819 Ku 9 = FQ} 
Ors 493 + BQ Kya F3y 
| ou eo 4 By9 K4 4 | | fe \ 
a" ¥ = | an FQ 4 T 34 Fai | 
Rae). 
van Ta Fy Fai ao Fay a 
F Fy FQy rate aioG Fas Fas 
foo ob k= @ 
a - Ti Fay Fay Ta T 34 S20) | 


wen aa FQ) ve toa Fa mie 


a 





Bema lly 


@ a 
Kis = Fy aes, 


v4 = -( Kare kia Au ekiy Aig) + Fas Fact 

mee = ty a\-Gi + U Ku 

ae = P@e Rai ees + 414 A292) + Fy Fy iC 

499 = -YC Ke +Ars KQQ +44 Aig) + Fai-cr-A 

Kay = = aie +AU KIS + KGa A1Q) + Fol FayCI EU Kay 

kqn = -C¥\4 + Ais X94 + Kay A129) -C Aa kag rkQ34Aag Ka4)t fa f4i-cI 
ee tay -CT - D+2-U xia 

34 = aaers) 20 £39 + K33+4+A99 K34 ) een ue We 14 

ay = 


-2( 424 Agi +K 34 +¥44A29)4 eee 


eine te Gi Vic 


Integration backwards in time is executed since 
until a steady state solution is obtained. 


Meee Tat  At= -at .whenq t-%; 
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The signs of all equations are reversed and the initial 


Genmaitions are those at t+ Tel hnen 


Yh = -'/p SKE = “cl Fay 9 | fr) Fas | Es 
or , 


DSAD= [ Ya Yau an Yau/u| = 


For the above, small changes are required in the original 
program (program 2 of Ref. 1). This is also due to the fact 
that the approximate proportionalities observed in Ref. l 


between the K's and powers of U (speed) were again found valid. 


2 
14! Ko 3 and Kr4 were inversely proportional to U . 
3 


32! Kage and Kaa were inversely proportional to U-. 


The controller gains depend on the selection of weighting 


K K 


a” 
K 


factors. It became apparent that a method was required that 
would indicate at least the region from which the factors 
could be selected. Such a method and the reasons that led to 
it are described in Appendix C. Using this method, two sets 
of weighting factors were found, the one with C=10, B=800, 
E=l1, and the other with C=0.001, B=164, E=0.001, which gave 
to the resulting controllers the desired characteristics. 

The weighting factors C=10, E=l, D=3000 (from Ref. 1) were 
also tested with the submarine at a speed of 15 knots and with 
no ballast added or removed. The controller failed to keep 
the submarine at the ordered depth. It was found that if the 
Submarine were brought "in trim," then the depth keeping 
ability of the controller was considerably improved. 

In Appendix D, a simplified trim analysis 1s presented to 


help in the calculations for the required ballast for the "in 


trim" condition, at different speeds. 
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For the stern planes only submarine, 


required in the rest of the simulation program. 


small changes were 


Db was set 


‘equal to zero and the bow plane angle generator was removed. 


Peesmort description, Connecting the methods of solution of 


is given below. 


the nonlinear equations of motion followed in Ref. 1 and 5, 


First step is the matrix formulation of the system equa- 


m@ens. in Ref. 5 


11) - XG O oO O 
@ ™-YG O -Y4 
© Oo ™M- 26 O 
O Bie O Tx- Ka 
© @ -Me o 
O -NG O -Nh 
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where the matrix coefficient of dot vector corresponds in 


Mer, Ll to: 
AAA ABA ACA ADA AEA AFA 
AAB ABB ACB ADB AEB AFB 
AAC ABC ACC ADC AEC AFC 
AAD ABD ACD ADD AED AF O 
AAE ABE ACE ADE ABE AFE 
AAF ABF ACF ADF AEF AFF 


Note that Xg6 corresponds tocOeFx6) or Xy etc. 

The above matrix, being a matrix of constants, iS inversed 
and multiplied by the vector in the right hand side of the 
Matrix equations, and the resulting six differential, non- 


linear equations are solved simultaneously. 
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III. BOTH PLANES DEPTH AND PITCH CONTROL SYSTEM 


Pee OPTIMAL SOLUTION, UNBOUNDED CONTROLS 

The approach selected for the design of the controller, to 
maintain automatically depth and pitch, was to let the planes 
individually achieve whatever angle was required to meet an 


Seeimal Control based on the minimization of the cost function 


ty 
Je sk{ (€@esv@ jar 


where Peo cace error vector 


IG 
T 


COncroOleVveCcoL 


Le) 
| 
tl 


weighting matrices 


That is, 1t was desired to maintain the state vector close to 
the ordered trajectory, without excessive expenditure of con- 
trol effort. It was assumed that admissible controls and 
states are not constrained by any boundaries. 

This approach was used also in Ref. 1 and for this reason 
only the required changes after the selected linear model for 
stern planes only submarine will be presented. 

The changes originated in the inclusion of term "U8" 
in the state equations and resulted in the following altered 


form of the gain derivative equations: 


‘ = Pee 

Kay = “Ve, HV" -\heg 109 + E 

ee \ \ Anh is - S 

Pe eee nid Bia Aey £1) Fay-dice Fig Fo9 
Ki3 ee eeu yes Vio, FaA Fal - i/o9 Fig fo 

Vig = Agr Yig + Kid 429 14 -Ve, Far Fu —Jigg Fig Fy 


H\ 


ah 2 
aa = 2(¥ig+Ais kaa + kau Aig) Vey Fal - 1, ae 
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Wg = Kid +Aia Kg +K34Aig-UKI2 -16, Fay Fai -4 eq Fag Fag 


gy = Viy +041 X94 + Ard ¥u4 +AQs Kog +29 K24 + K93- i fy Fay - eg Faa Fag 


: a 
“33 = QU KID - 1, Far - Veg F329 + D 
V2 = — Ll ieee Ag: Ko4+ €334A99 K34 ~Me, 73) Fa -\/o9 Faafyg 


2 
uy = 9 CAar- Kay + K34 499 Kan) -1/e1 Fai -A/eg Fur +B 


1729 were included for the case that different weighting on 


the planes effort would be desired. As used in the simulation 


runs of this paper, C was set equal to C1 7C>: 


PCONSLTRAINTS ON ADMISSIBLE CONTROLS 


ire same Controller in an alternate form can result if 


bounds are defined on the controls and Pontryagin's minimum 


principle applied. 


aT % 3" ry eT a 
Eom || - Al Eqtrugdj+p Ewe eS 


IC + 


Separating the terms that contain UW 
T 7 
Wg uURutPpRu or 


C ' Ce a 
\/9 | Ds De | oo a ae + | Pg 93 Pals a fs = 


1S) 922 


“ 


1/9 (C1 Ds +Cab) +| P28 +4 Big 02 Bas + Py B23 | a 


Under the assumption of independent controls, the quanti- 


cles to be minimized are: 
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Vg Gi o 4 (PeBu+ py Big) [Ds 


19 C2 Dy + (02 ba+pa 22) Dh 
corey 
| | Ceeie yaad (-95°) 
[Ob] 0.436 rad (+357) 


For the time that the controls are not saturated: 


Ds Be Va Py Bil (equaleeco.DSAD on Ehe original 
eA program of reference (\ ) 


Db Bese taue pa O99) (equal to DBAD in the original 
co program of reference (| ) 
For Pq i144 Pa BID eee 
ei 
Po Bar + p4 
2 el 
C3 
finally: 
ee -0.436 <2 a <A NG GUN = Gi 
z REGS 0.436 ec aa nO) eS AIG 
If -0.436 CR FEB L O.436 then \Db=-REGR- 
it REGBY O. 436 then Db=-0.43¢ 
rf A BCR -acee ther, Dio= O.43G 
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The two controllers are equivalent. The one will be 


referred to as unbounded and the other as bounded. 


See LLNEAR TRACKING CONTROLLER, EXACT DESIGN 

Until now the procedure of Ref. 1 was followed and the 
initial tracking problem was converted by use of simplifying 
approximations to a linear regulator one, where it was desired 
to meGintain the state error vector close to the origin. 

From an attempted more exact examination of the linear 


tracking problem, a modified controller resulted whose cava- 


bilities are considered greater. This is because approxima- 


mons such as use of E=AE+ BU instead of the correct 
E=AE+Bu-Av are avoided. 
Forming the Hamiltonian [Ref. 5] 


He Veileerie + VallUlla+ Pax +o Ru 
pe ~72 $ ui =n q B' © 


Ons of | 
5 - 
and for ome KX + SD 
a a <4 a 
Ua -RBKX-R Bs where 
B= -KA-AK-Q+kK BN RK 
5 mee 2 Sh 2s +e x 
with x(as)= H , S44) = - 


Integration from te, to t, gives K and S.With 


[au 


= O K results 


as before. 
Using the symbols and notations of Ref. 1 then, 


es See Ke o's") oat , where once again 


6] 





pO 
ll 
ty 
O 
O 
S 


O A O O 
O O D O 
O O O B 
ZODR 
and r = O 
PORD 
© 


fmomexpilicit form 


a —( ‘ic Bu Tus Veg Ba Fx) 59 - Oe, Bia kig+ icy Bq 2)s4-E-ZOpR 
Sa = 34 FCA - A/es 04 Far - t/cg Rar Faq) $2 +(Ara- ler BiaFas -A/eq B29722)S4 
53 oy Si — Gea Du Fars die SQ) F39) 52 +(-4e, (319 Fai-A/eg Bao F3@ | 54 -D-PORD 


S4 (AQ - ders By Fa-Voeg Rai Fag) s9 h 33+(A29- 16,819 Far- eg oo Fug )-S4 


il 


* = 
mmere expression for WU the part -R s Be IS 26 “abs ele Sven 


mompeemerMie regulator Case with xX the state vector instead of 


Meee Crror vector. So, finally 


DSAD = Yu - DEPTH FQ -ZOCOT/U + Yan -PItcH 4NaI -PIDOT/U 
-\/e. (By -Sa¢ B1Q-34) 


DBAD = Y12-DEPTY +Y¥aq-2ODOT/U + Vag. PITCH + Yag-PInOT/U 
-41/CY ( 91-SQ + HQ9-S4) 


BOmsbOuUnGcea COnEroOlS and 


(1) controls unsaturated 


- Vcr ( Pq-Bu+P4-Br9 ) 
DBAD 





i/cq (04 -Bar+ 94-192) 
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This is easily shown from 


ae = Ou OCB) 

Qu is DU 
= RU +B p which implies 

w= -8 Bp 

(2) controls saturated 
For REGS > 0.436 DSAD = —0.436 
" REGS < -0. 436 DSAD = 0.436 
" REGB > 0.436 DBAD = -0.436 
"  REGB ¢ -0.436 DBAD = 0.436 


The controller now becomes: 


feet? WEPTH +22 = ZONOT + K93 - PITCH 4+ 94 - PINOT +52 
ph < wig + DEPTH +KI4 -ZODOT +K34 “PITCH + ¥44-PIDOCT+ 94 


meeGS = ( Pq. Bis + Pa ai) / C1 
meGcoh = C pa: ida 4 YA 99) /C9 


Sec: 


fee taolTING THE CONTROLLERS 

All tests were run at the forward speed of 15 Knots and 
with the values of the weighting factors C=10, D=3000, E=1l1, 
to provide results for easy comparison with that of Ref. l. 

To check the depth keeping capabilities of the bounded 
form of controller under the presence of external disturbances, 
a vamp input AU = -2.E-05-TIME, was applied at the auxiliary 
MmemMeeank (Fig.iV-4+ ). The results are shown in Fig. III-1l 
for the otherwise unballasted submarine. 

The controller kept the submarine at near zero depth until 


the fairwater planes became saturated. Then the "light" 


63 





Submarine started losing depth quickly. The following must 
also be pointed out at this point: In the unbounded controller 
of Ref. 1 and in order to limit the effect of initial depth 
error (corresponding to a large step order) resulting in large 
plane angles, unachievable on a real ship, the depth and pitch 
errors were limited as shown in Fig. III-2. The limiting 
values tested were + 2 feet for depth and = 10° for DLteh 
errors. Also to reduce the noise level in the plane positions, 
the plane angle ordered was filtered with a simple low pass 
meter. 

In the test of Fig. III-l, the limiters were preserved in 
the bounded controller but the filters were removed. Thus as 
seen in Fig. III-lc., although the submarine reaches a depth 
of -80 feet, the reaction of the unsaturated stern planes is 
very slow. 

From Fig. III-3 and III-4, the effect of the low pass 
filters can be seen. Fig. III-3 shows the response of the 
submarine with bounded controller and without filters to a 
Sinusoidal input, aAU=2.0x 40° MamsunenOao ° ©. 

Figure III-4 presents the response to the same input when 
the unbounded controller of Ref. 1 as modified in this section 
is used. Except for noise components, the results are other- 
wise Similar. 

To compare the effectiveness of the controllers to depth 
changes, an ordered depth of 10 feet was used. Figure III-5 
shows the response of the submarine with the unbounded con- 


trollers, with limiters and filters. 
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Figure III-6 presents the response of the submarine with 
the bounded controller, with limiters but no filters. Again, 
no appreciable difference is detected, as was expected since 
the controllers are in fact the same in that region of opera- 
tion. Both responses were acceptable. 

In Fig. III-7, the submarine was ballasted with AU= 


2 a AT=-6.4X10 >. The bounded controller 


oeel0) , FT=6.4X10— 
was tested for its ability to keep depth. To check this, the 
ordered depth was put to zero. The controller maintained a 
steady state depth error of 0.05 feet and a steady state pitch 
error of 0.0002Yad.A steady state fairwater plane angle of 
about -0.7° was required to maintain depth. This small value 
implies that the simulated submarine was almost "in trim." 

The next test was again with the submarine unballasted. 
A depth of 10 feet and a pitch of -0.150 rad (-8.6°) were 
ordered with the tracking controller in use. The error lim- 
iters and noise filters were removed. Responses are shown in 
Fig. III-8. Although the resultant steady state values of 
10.4 feet and -9.8° could be considered acceptable, the sub- 
marine overshoots to a depth of 24 feet before achieving its 
final depth. The negative pitch was ordered in order to 
speed up the depth change but on the other hand this created 
difficulties for the planes in their action to stop the 
peeching Submarine when it reached the ordered depth for the 
first time. 


In Fig. III-9, the same maneuver was repeated while a force 


AU=2X107* Sinevectewas also applied on the boat. The results 


were similar. The depth overshoot was not acceptable. 
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Since it was desired to be able to use suitable pitch of 
the submarine when ordering depth changes, the method of pre- 
senting the orders to the tracking controller was modified 
and the following statements were added to the program: 

fee -O.059 
pa = (OO 32 


AOCG= ABS CDCHNG) 


DY = 90. +ANDCE/RATE 

eee = (COCHNG)- P12 /100 

A = (Pa Ve (exe 

YQ = QAMP (OY) 

ZODR = RATECVI-Y2).OcHNG/aAnc.| 
Beem = EIMIT CPT ioe) 


The inputs were now the desired depth change and the rate of 
depth change (DCHNG and RATE). Suitable pitch between PL and 
PL, 1s automatically ordered during the depth transition. The 
values of RATE, PL PL, anGeeneesOrn Of XD Can Gasily be modi- 
fied to achieve desired depth change characteristics. 

In Fig. III-9, results are presented for the ballasted 
Submarine, the sinusoidal input P= ena sin Os3eysuper— 
imposed and an ordered depth change of 50 ft. The eee en 
achieved without significant overshooting, was 51.7 feet and 
me pitch 0.019 rad Ce The values of the parameters 
RATE, Py Fl, as appear above, were selected to give a response 
Similar to that of the submarine in Ref. 1 with the unbounded 
controller, the error limiters and noise filters. This was 


memmrpea by the results. 
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Although setting bounds on the planes may lead the boat 
to unadmissible limit cycles, the nature of the near surface 
problem prohibits the use of the unbounded controller with 
error limiters when improved performance is desired. 

The tracking controller, due to itS more exact design, 
is expected to have better performance. With the introduced 
method of ordering depth changes, the error limiters are no 
longer necessary. Further investigation is required on the 
operational characteristics of the tracking controller. 

In the rest of this work, the bounded controller is mainly 
Beas Gne to the fact that it was developed earlier. Lack of 
time prevent duplication of the tests with the tracking con- 
fSeorler in use. 

meetdg. Lli-l0, the block diagrams of plant and controller 
in the linear regulator problem and in the linear tracking 
problem are shown together to depict differences. 

In Appendix C, the method developed to connect linear feed- 
back with optimal control theory is examined for the possibil- 
ity of its application in the case of the both planes submarine. 


It may be repeated here that the results are rather prohibitive. 
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ive CONTROLLER FOR THE NEAR SURFACE SUBMARINE 
Ser ORMULATION OF THE CONTROLLER. COMBINED MODE 

CONTROLLER (CMC) 

The need for an improved depth keeping performance for the 
near surface submarine under a seaway led to an investigation 
for an "optimal" near surface controller. 

The inadequacy of the already designed optimal unbounded 
and bounded ones is easily and simply demonstrated. A 70-ton 
pulse input is applied at the auxiliary trim tank and the 
unacceptable results of submarine response shown in Fig. IV-5 
and 6 are discussed in the simulation section of this chapter. 

The phenomena governing submarines response to submerged 
turbulence are not completely understood and much of the 
existing experimental data have been classified. Thus many 
Simplifications were accepted in the formulation of the prob- 
lem and a great effort was initially devoted in the direction 
of finding a mathematical proof that would suggest an optimal 
solution to the simplified problem. Even this task was proven 
very difficult to the author and a mathematical solution was 
unattainable in the time allocated for this work. 

The next step was toward the examination of a proposed. 
controller scheme, for which existing test results were known 
to be encouraging. In that scheme, two separate control sys- 
tems are designed, one based on having both planes available 


and the other based on stern planes only control. The two 


stern planes commands are then computed and combined as a func- 


tion of the forward plane command. 
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Oe Oe Teor, sDepen Rate, Pitch Error, 
Pitch Rate) 


Defining Sey 


stern plane command in both planes mode 


S52 eee DOpeMmeurrorm, Depth Rate, Pitch Error, 
Pitch Rate) 


stern plane command in stern only mode 


S$com = O54 


Mme Domen Error, Depth Rate, Pitch Error, 
Pitch Rate) 


bow plane command in both planes mode. 


then the actual stern plane command formed of a linear combi- 


nation of 951.082 1s 


Sscom = K-Os! + (1-K%) dsq cohete 
1. vy | dfcom| <Of$-max 


(1.e. bow planes not saturated) 


\A= ty (oh com, dfmax) otherwise 


x 
The function K = oak was used with § fmax = 0.436 (-25)) 


and x a variable parameter. 


Poemoroolem Now waS to try to find a "best" value for xX 
for most acceptable controller performance, test the general- 
meyeOL this value in various kinds of controller designs and, 
1f possible, also find a mathematical proof of its uniqueness 
Or at least a proof of the existence of a restricted region 
of permissible values. For convenience, the following abbre- 


fetelons will be used in the next. 


peor woec. = stern only planes optimal controller 
sO PC = stern only planes controller (not optimal) 
Eee Oo C =weOetwmolanes Optimal controller 
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= MC = combined mode controller (meaning the 
proposed scheme) 


Mmamrs again noted here, that theS OPOQOcC. andBPOC 
designed in Chapters II and III are in fact optimal only under 
the assumptions of unbounded states and controls. 

The synthesis of the C MC. was realized at first by the 
use of the already designed S OPOC. andBPOC. Then the 
SOPOC was replaced inthe CMC by aS OPC. corres- 
ponding to a characteristic equation, same with that result- 
Meemerrom the B P OC. The formulation of the C MC. from the 
independently designed SO POC or S OPC andBPOC ones 
ZS indicated in Fig. IV-1 to 3. 

In the next section of this chapter simulation results, 
mainly of the use of C MC ona submarine excited by external 
forces, are presented. Parallel analysis of the data on indi- 
vidual and comparative bases is attempted. 

Some conclusions appear proper at the end of the chapter. 
The part concerning the question of the generality of a 
unique "best" value or region of values for the C M C. param- 


eter is left for the next chapter. 


fee OLMULATION RESULTS 

The computer used for the simulation was the I.B.M. 360/67 
located at the W. R. Church Computer Facility of the Naval 
Postgraduate School. 

Puegeame2, developed in Ref. 1 as a modification in D.S.L. 
femelle OLlginal N.S.R.O.C. digital program of Ref. 3, is the 


Main program used. The hydrodynamic coefficient values were 
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kept the same and all runs were made in forward motion, at a 
@Bemetant speed of 15 knots (25.33 ft/s) and with the submarine 
Meeroximately “in trim." Appropriate modifications in the 
Bem@eerons that lead to the control orders to the planes were 
made occasionally, as for example in the case of the S OPOC. 

In all cases the linear model, derived in Appendix A, was 
used. The trim-controller part of the program was not 
operated. 

To simulate the effect of an external forcing term, water 
was removed or added to the trim tanks whose position as de- 
Mmemeae2n Ref. 1 is shown in Fig. IV-4. The depth and pitch 
Peony Limiters used in the controller of Ref. 1 had to be 
removed when operation of C M C. was considered. They were 
mieaeinitially in the unbounded controller in order to avoid 
excessive values of the planes in response to a large step 


order. Continuation of their use will undesirably alter the 
aah 

d$com 

affect the operation of the C MC. 





values of the K Function (x=( ; and consequently will 

Pieeetrst the narrow pulse force shown in Fig. IV-5a was 
applied on a submarine (forward trim tank) using the BPOC. 
with bounded controls and with the limiters removed. The 
controller had weighting factors B=800, C=10, E=1. 

Beemer tg. LV-55 to IV-5e, it 1s seen that the controller, 
after the saturation of the bow planes, acted slowly to sta- 
bilize the submarine with a steady state depth error of about 
-65 ft and a steady state pitch error of -0.086Yad.The bow 


planes never recovered in the time interval of 200 sec. the 
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simulation was held. In the case of the bounded controller 
with B=164, C=0.001, E=0.001, application of the same input 
Beemcestructive as shown in Fig. IV-5f to IV-51. 

The controller with B=800, C-10, E=l was also tested with 
Geemiimicers replaced. The controller succeeded now in re- 
turning the boat to the ordered zero depth and pitch but with 
an overshoot of about -30 ft in depth (Fig. IV-6a to 6d). 

When the weighting factors were changed to C=10, E=1, D=3000, 
the controller failed completely again (Fig. IV-6e to 6h). In 
all cases the results were unacceptable and simply show the 
inadequacy of the designed B P 0 C with bounds on the con- 
Beers and with or without error limiters, to handle situations 
approximated by the application of the pulse force. 

All of the subsequent test runs in this chapter simulate 
motion of the submarine using the C MC Only three kinds 
of external excitations were considered, the pulse force at 
the forward trim tank, shown in Fig. IV-5a, a step of the same 
Magnitude at the auxiliary trim tank, and the same step at the 
forward tank (Fig. IV-7a). 

ieee peliCation of Step Force at Auxiliary Trim Tank 

Since it was desired to check the operation of the 
CMC after the saturation of the forward planes, the magni- 
tude of the step was selected big enough to cause saturation. 
The C MC was formed by the combination of aS OPOC 
andaBPoOC (bounded) having the same weighting factors. 
Under the above conditions, two controllers were 


tested. The first one with weighting parameters B=800, C=10, 
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E=1; the second with Betas C=00 00. BP=OnOo0 le There 1S a 
distinct difference in the resulting controller orders, which 
was the reason for the selection of the above two sets of 
values. The optimal controllers, when the approximation of 
Mitinite duration control interval is used, result in time 


invariant state feedback given in the program in the form (for 


Memenworder to stern planes): 


d5= Wi -ZOEQ +N /Uc -ZOWOT #31 PERR wNat/uc- P1007 


where are. Mepth OV VOV 


Zoner = Depth rate 
PeaR =Pitch evvor 
PINOT = Pitch vate 


and Yay Yoys Yay: Yay are linear combinations of the gains 
maeene K matrix. 

The values of Yay etc. in the tested controllers are 
given in Table IV-1. 

Parngeede Closed loop C.E. derived in Appendix C, it 
is seen that 431 of the first controller, if used as the order 
to the planes in a stern planes only case, 1s expected to 
result in a stable submarine (roots with negative real parts). 
851 Seeeme Second Controller in a similar use is expected to 
result in an unstable submarine (roots with positive real 


Parts). 


For each of the combined mode controllers, different 
values of X were tried. The first controller showed improved 


response in terms of steady state depth error, as Xwas in- 


Creased from 0.005 to 500. Results are plotted in Fig. IV-7 
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to IV-15 and arithmetic values of important response charac- 
Memmstics are collectively presented in Table IV-2. From this 
table it is seen that for X=0.3 the steady state depth error 
was approximately -6.4 ft and the steady state pitch error 
oy.9 X ioe rad ee For X=500, the s.s. depth error was 
Bepmoximately -4.52 ft and the s.s. pitch error again -2.9 x 
oi rad. Both responses are considered acceptable and so, 
Beeeenis controller the steady state error criterion does not 
Mmm@eese any strict limits on X. Control effort differences 
are not easily distinguishable and simple inspection of the 
stern plane angle plots is not enough for conclusions. 

When the value X=0.5 was used in the C MC , the stern 
plane angle attained its minimum s.s. value. 

The second controller (B=800, C=0.001, E=0.001) was 
tested for the values of K between 0.5 and 6.0. Numerical 
results are given in Table IV-3. For values of X greater than 
3.75, the system was unstable. 

imeere. 1V-16, the response characteristics of the 
Submarine with the C MC controller and X=6 are plotted. The 
plots are representative of responses resulting from the CMC 
with values of X greater than 3.75. Responses for X less than 
Mumemeare plotted in Fig. IV-17, 18. For X=0.5, the stern 
plane s.s. angle reaches a minimum value. On the other hand, 
the s.s depth error is minimized for X values near 3.75. 

The region of acceptable values of K is considerably 
reduced in this controller. Again, steady state error and 


control effort criteria are not enough to distinguish any 
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"best" value at the exponent. Responses to positive or nega- 
tive step forces were similar (opposite sign). 
Beet tcation of Step Force at Forward Trim Tank 

The step force was applied to the forward trim tank 
and each C MC tested again. Application of the force to the 
aft tank was not considered since it will saturate the stern 
planes first. 

Use of the first controller (B=800, C=10, E=1) with 
values of X greater than 0.9 resulted in unacceptable responses. 
The submarine followed a sinusoidal path between a depth of 
meoeto —45 ft. 

In the region 0.005 ¢X0.9 and among the tested 
memes, x—-0./7 gave minimum s.s. depth error of -25.15 ft, 
steady state pitch error of -0.14 rad (8°) and minimum stern 
plane s.s. angle (11.16%). 

Table IV-4 presents numerical results of the tests, 
while the corresponding responses are plotted on Fig. IV-19 
Semi v—-23., 

In Fig. IV-19, the value of X=1.0 has been used but 
the curves are characteristic of submarine responses for values 
fee iarger than 0.9. 

Use in the second controller (B=164, E=0.001, C=0.001) 
of X=0.5, gave the first indications of its stabilizing capa- 
bilities. After a transient oscillating period the submarine 
reached a s.s. value of -28 feet in depth and -3° in Dineen. 

Values of X greater than 0.5 resulted in a sinusoidal 


response of the boat around an average depth of -40 ft. 
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The response characteristics for X=0.9 are shown in 
Pig. IV-24 and are representative of responses when values of 
feegceacer than 0.5 are used. 

Baemmelagle ~£¥=5 and Fig. IV-25 to IV-28, it is seen 
that values of X around 0.4 result in relative better response 
characteristics. The value of X=0.005 is destructive for the 
meat, sending it quickly to the surface at an increasing posi- 
tive angle. It is noted that when the step was applied at the 
forward trim tank, permissible values of X became smaller and 
were restricted also in smaller interval. 

Application of the step on the forward trim tank 
results in higher values for depth and pitch rates than in the 
case where the step was applied on the auxiliary tank. This 
can be used as a crude indication that higher rates require 
smaller values of X, but in any case no indication was found 
that there is a unique "best" value of X. 

Since application of step input forces and moments 
and use of minimum s.S. errors were not considered satisfactory 
for the representation of near surface effects and determina- 
tion of the "best" value of the exponent X, the next step 
meseca application of pulse forces (approximating impulse 
ones) at the forward trim tank. 

3. Narrow Pulse Force at Forward Trim Tank 

The magnitude of the pulse force used was the same as 
Perecthie step, i.e., about 70 tons. Its time duration was 
mo Ss. (Pig. —IV-5a). Both controllers with B=800, C=10, E=1 


and B=164, C=0.001, E=0.001 were tested. Table IV-6 presents 


82 





some of the important characteristics of submarine response 
mmemetne first controller is in use. Corresponding curves 
meemeiowt in Fig. IV-29 to IV-36. For values of X larger than 
0.6, the submarine is unstable. Responses are similar to those 
ma@emeecaced in Fig. IV~-29, which correspond to X=0.7. Values 
of X from 0.005 to 0.6 gave acceptable results. There are 
small differences in depth and pitch overshoots but these 
differences are not sufficient to justify conclusions about 
Mmeematity Of a specific value of X. Values of X between 0.45 
and 0.6 result in slightly improved response characteristics 
in comparison with the rest of the permissible values, when 
depth overshoot is considered. 

Tests with the second controller gave, in general, 
Unacceptable results. For values of X larger than 0.2 the 
boat was unstable. At the value of X=0.005, once again the 
controller fails and the submarine moves unhelped to surface. 
The results are shown in Fig. IV- 3] to IV-42 and in Table 
ny= 7). 

Judging from the tested values of X, it appears that 
the best to be expected after the pulse is removed, is a 
Slightly damped sinusoidal response or even a small amplitude 
undamped one. For this to happen, the value of X is expected 
to be between 0.1 and 0.2. 

4. Simulation with an Alternate Formulation of the CMC 

Existing information from previous experimental work 
Dy other sources revealed that the value X=0.5 could be "best” 


for a specific design of combined mode controllers where 
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(a) the both planes component-controller was designed 
Soeimal. 

(b) the stern planes component-controller was designed 
meegive the same closed loop C.E. as in (a). 

(c) Set of the both planes-component-controller if used 
in a stern planes only submarine, would slightly stabilize it. 
The optimal both planes controller with B=800, C=10, E=1 ful- 
RmePecCOndition (c) and the corresponding C.E. found from pro- 
gram 6. was used in program 4. to give feedback gains in dsQ 
Semenme CMC. The controller used in Ref. 1 with D=3000, 
C=10, E=l also satisfies the condition (c) and was tested 
me M C too. 

To complete the picture, the controller with B=164, 
C=0.001, E=0.001 was used in similar tests, although it was 
known that its order 8s would result in an unstable stern 
only mode submarine. 

In Fig. IV~43 to IV~47, the response characteristics 
of the submarine to a pulse force at FT are presented. The 
Mero uses a BB POC with B=800, C=10, E=l andaS OPC 
resulting from the same closed loop C.E. | 

Numerical results are collectively presented’ in Table 
IV-8. Compared with the results in Table IV-6, they are 
inferior. The value of X=0.5 doesn't appear to be a "best" 
one. Rather a value of X=0.1 would be preferable for use in 
a controller. 

ims wiomatune was also simulated with D=3000, C=10, 
E=linBPOcCc andSoOPcCc with the same closed loop C.E. 
SEEMEEeM@rested values of X (i.e. 1.0, 0.8, 0.6, 0.5. 0.4, Q15) 


resulted in unstable operation. 
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mmemiees £V-49 to IV-50 and Table IV-9 present the results 
when inCMC,BOPC andSOPOC with the same weight- 
ing C=10, D=3000, E=1 are used. 

The last tests are with C MC that makes use of 
BPOC with B=164, C=0.001, E=0.001 and of S OPC with 
the same closed loop C.E. For values of X, 0.1, 0.3, 0.5, 
the submarine is quite unstable. 

In Table IV-10, the permissible values of X for use in 
CMC are collected and presented in a condensed form. It is 
seen that only in the case of CMC using B POC and 
Seorre C are there enough cases with "best" value of .X around 
0.5. Even in these cases, the dependence of the parameter on 
the input force and on the design of the particular controller 
(i.e€., weighting factors) iS apparent. 

The strong indication that the "best" value of X lacks 
generality and that only strict specifications would result in 
the acceptance of a certain value (for example X=0.5) as opti- 
mum in some sense, led in Chapter 5 to a further investigation 


of the proposed C MC. 
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SPiMeablon results of the application of a 70-ton 
Step Ponecenah Bie auxiliary trim tank.The submarine was 
“in trim" and the CMC used optimal design in the combined 
eemcurollers,with B=800. ,C=i0.,E=1. 
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TABLE IV-3 


Simulation results of the application of a 70-ton 





step force at the auxiliary trim tank.The submarine was 
“in trim" and the CMC used optimal design in the combined 


memorolLlers with B=164.,C=0.001,F=0.001. 
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Pimulation results of the application of a 70 ton 











step force at the forward trim tank.The submarine was 
“in trim" and the CMC used optimal design in the combi- 


Peemeonorollers with B=800. ,C=10.,EB=1. 
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TABLE IV-5 
Simulation Mente connie appiication of a 70-ton 
step force at the forward trim tank.The submarine was 
rin trim" and the CMC used optimal design in the combi- 


memmeoitrollers with B=164.,C=0.001 ,E=0,.001 
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TABLE IV-6 
Simulation results of the application of a 70-ton x 
10 s pulse force at the forward trim tank.The submarine was 


"in trim“ and the CMC used optimal design in the combined 


Semceollers with B=800. ,C=10.,F=1. 
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Maximum Depth Maximum Pitch Time to positive 
overshoot(ft overshoot(rad) Heoth peak(s) 


eeagdual oscl 


mig 


Residual oscillations 
0.05 19.37 4.33 (0.00157 0.0192 oe 





Simulation results of the application of a 70 ton x 10 
pulse force at the forward trim tank.The submarine was 
wt 


in trim'' and the CMC used optimal design in the combined 


meer ollers with B=164. ,C=0.001 ,E=0.001 
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simulation results of the application of a 70 ton x 10s 
pulse force at the forward trim tank.The submarine was 


in trim '' and the CMC used combined Conuro Llerc 
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Pieacmemeresults of the application of a 70 ton x 10s 


Mme force at the forward trim tank.The submarine was 


4 


in trim’' and the CMC used optimal design in the combined 
Sentrollers with D=3000. ,C=10.,E=1. 
2. 
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ean Cine eN VEST EGATION OF THE 


COMBINED MODE CONTROLLER (CMC) 


PeeeeeNALYSIS OF CONTROLLER OPERATION 

In Chapter IV a controller was devised for the near sur- 
face submarine. Its stern plane order was formulated by the 
combination of the stern plane orders of two separately 
designed controllers, one for a stern planes only submarine 
and one for a submarine having both planes available. 


time Order took the form 


dscom=kdsi ¥CieK) S52 with k= (2488 ‘ 
| 0 f$dom 


and was used for values of K Gale 

In one case, the two separate controllers were the result 
of optimal design with the same weighting factors for both. 
In the second case, while the both planes controller was kept, 
the stern planes one had its gains adjusted to give the same 
mmosecd loop C.E. The controllers were used on a number of 
Simulation runs and in order to compare their effectiveness 
under a sea way, step and pulse forces were applied on the 
submarine. 

It was desired also to determine a value or region of 
values of the parameter X that would correspond to improved 
performance of the system. If existence of such a value or 
region of values was apparent, then a theoretical justifica- 
tion would probably follow. 

Examination of the results shows that such a value or 


region of values is not likely to exist in general. On the 


ai 





other hand, for a certain controller design and under certain 
Memes, values of X around 0.5 seem to offer better results. 

More specifically, as seen from Table IV-10, this was the 
case for the C MC using optimal separate controller design 
with weighting factors B=800, C=10, E=1 or D=3000, C=10, E=1 
and when a narrow pulse force was applied at the forward trim 
teak . 

Ween the controller with B=164, C=0.001, E=0.001 was used, 
the results, not acceptable in general, showed improvement 
meeevalues Of X around 0.15. It appears that "optimality" of 
X is directly connected with the design of the separate con- 
trollers and the type of applied force. This then implies that 
generalization of the results is not possible and a specific 
value of X only accidentally can result as the “best” ina 
CMC with arbitrary separate controller designs. 

To further investigate that view, the following procedure 
was adopted: A linear relation is assumed between 851.852 
for example 55) = \-99 Wheresi\) iS a conStant. Then 
K-Osi + (i- 1) -O59 
O59 + “w (Os1- 52) 
eo | ya K-(a-!)] 


Setting M=1+K’ (f\-4) gives Sscom=.™-ds9. So under the assump- 


dscom 


| 


tion of a linear relation between the orders S51 , O52 , the 
result is that Oscom can be expressed as a linear combination 
oki Ss9 only. 8$com is used in C M C when due to the appli- 
Cation of the external forces, a stern planes only submarine 
Configuration has resulted. To each value of M, a stern planes 


only controller corresponds. 
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From this family of controllers the one or the ones with 
the most desirable response characteristics to certain inputs 
can be found by tests on the stern planes only submarine. 

Then the "best" value of X in the original expression of 

will be the one capable of keeping the values of M near the 
selected one, for all the expected values of Ofcom . In this 
way, the dependence of X on the controller designs and the 
applied inputs will have been shown. 

The above can be considered as a short description of what 
now is presented in detail. 

From optimal design with the assumption of infinite dura- 
tion process and in general from the case of state feedback 
design, 539 results in the form 

O52 = SOA-X%1 +$08-%2 + $OC-X3 ESO0D-X4 where 
5! Xay Xi are the states and SOA, SOB, SOC, SOD are the 


Gains. The closed loop C.E. as found in Appendix C is given 


Aas Xx 


by: 
5) \( ae a2) men So. 82-800] = 


+] Grasse as) =a ‘SOA+(A2a- By aera -29)-S08 - 39-50 a 
+ (A141 -g- ators) )- som 


«|(8:-Paa-Be-Aa1 + Baq-Uc)- SOA (82-8 11-Bi-A 12): 80¢ |-5 


sae B9- Ue Ail). 508 | 
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Then the order §3com = M -O52 Pere stiostleured In, will result 
in variation of the position of the elgen values of the above 
equation, since the gains are multiplied by the parameter M. 
For each set Be values of feedback gains corresponding to a 
certain design of stern only mode controller, the characteris- 
tic equation takes the form: 

s+ (AM +Ci)-S + (BM HCq)- SS + (Cm +Ca)-5 + OM+C4) 


Pee the given submarine at the velocity of 25.33 ft/sec: 


Cc, = 0.1982 
a = SMetiGho en 
C, = 0 
v= 0 


Ewaeoyee, © Calculated in program 8 are functions of the 
P—aedex GalnsS. This form 1S sultable for root loci methods. 
The loci were plotted for different controller designs. It 
must be noted here that root loci methods are not in general 
helpful when impulse responses are examined, since there 
doesn't appear to be any simple correlation between pole motion 
and the corresponding translent response of the system. The 
trouble arises because the pole -zero concepts essentially 
refer to linear systems. As soon as the poles are in motion, 
the usual relations between pole and zero positions and over- 
shoot for example, are no longer valid. What was done in that 
case was to try to use probable existing simple correlation 
between pole motion and transient response, which would ex- 


mia aceidental “optimality” of the exponent 0.5. 
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The following cases were examined: 

(1) SOPOC and BPOC with weighting B=800, C=10, E=l1. 

(2) SOPC and BPOC (B=800, C=10, E=l1) with the same 
Sesed loop C.E. 

(jo SOPOC and BPOC with weighting B=164, C=0.001 and 
mo. 001. 

PmmerceorPe ana BPOC (B=164, C=0.001, E=0.001) with the 
same closed loop C.E. 

fue SOPOC and BPOC with weighting D=3000, C=10, E=1. 

(6) SOPC and BPOC (D=3000, C=10, E=1) with the same 
eesed loop C.E. 

To establish an approximating relationship of the form 

Ss = \- 852 PeENeerORl@wing Sampliftying assumptions, 

valid only for the given submarine, were made: 


(1) Average depth rate during application of impulse at 


FT tank = (-0.7) - (-0.8) ft/s. 
(2) Pitch rate = Pepen nate to Heel = a 


The above values are averages derived from tests made on 
the given submarine by applying forces of about 70 tons in one 
of the auxiliary tanks. To saturate the forward planes, the 
Forces have to be applied in the forward or the central (auxil- 
meacy) trim tanks. 


Then: 
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S51 = FSA- Xi + FSB-X2 4+ FSC: %34 + FSD: Ky 
ore = df$com Pee eee f DO 4a Pine: xs + FISU- 44. 


}s2 = S0A- xX) + SOR-K2 + SOC: K¥ + SOD: X4 


et 
Setting Rea geo Sl, A = 


IV NN 
AsQ = SO a se ening) =) | SOD son) |x 
ie NY | 
O$com=| | FOA+ EBC + +(resree0)) 
Dy N 
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1. SOPOC and BPOC with weighting B=800, C=10, E=1 





Beeom Optimal controllers From program 8 
FSA = -0.20694 x10 A = 0.77984 
FSB = -0.4043 B = 0.45489 
foe = 15.321 C = 0.10600 
FSD = 58.51 D = 0.49318 x1o"* 


FBA = 0.3155 
mee = 1.1073 
fee = ~32.57 
mep = ~73.85 
pee = —0.31623 
SOB = G55 
pee = 53./1 


Sep = 158.71 | 


Then, using N = 175 


Ssi x foneextos- -t = 0.07)- X., 

Meme (-9.32x10° -t -0.758)- - 

Osi = (0.129-t + OMae =) romanc witnexe~ 0.18 
Off = -0.103°t*-0.55 


For values of t between 0 and 12 s., (time duration of the 
pulse force plus 2 s. for which the submarine is considered to 


continue its path with the same characteristics) ,d{y varies 
02436 


\9$1| 


0.79 to 0.244. The average value of r will be 0.433. 


between 0.55 and 1.79. The ratio r= 





will vary from 


re 
Also, Ost _ 6.68 x10*-T-O-O7 and 


—- 


SS Reo Oo. 158 
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The average value of (as 1s approximately -0.245. 
From ds$com = =OS2 4+ K(Osi- o2) el Clue © 
Os = -O.2A5 852. 


dscom = dso -( 1 - 4.245 K ) 
= 632 -™ 


iiescorresponding root locus is plotted in Fig. V-l. Fora 
system with a dominant pair of complex roots, values of 

in the region of 4 = 0.4-0.6 would be suggested. In this 

case, the order mM -ds2 was used in simulation runs of 
a stern only mode submarine with vy taking the values Osi; 
mo, 0.8,1i , {.2. 

To compensate for the effect of the forward planes, the 
magnitude and the time duration of the applied force were 
Beauced to about 35 tons and 6 sec. correspondingly. The 
results are shown in Fig. V-2 to V-4 and suggest values of ™ 
between 0.3-0.6 (§ = 0.22-— 0.4). Then, 

<1- 1.245K ¢ 0.6 leads to 


0.562 » K » Omesoal 


X 

Using K = icon = ieee 
Ofcom 

me 562 »S (0.433) _— 0.321 and 


0.69 <x 4 ies. 





Tf in the the above calculations the extreme values of 


} 
= = OE 092 and of ea Ueoaeace Used, they result in 
Mea XC 3852 
hE tne values a = = Oe 69 and of = -1.79 were used, then 
ene A : ; e ’ e 


: 
2a < X ZL 0.92 


Finally, if the value N=200 had been used, it would result, 
; 1 £ ree d 3 
using average values for and r, in: 
S2 


mee = -0.165-05S2 


2. SOPC and BPOC (B=800, C=10, E=l1) with the same closed 


imeeop C.E. 
mrom BPOC From program 6 

a ee 3 2 
FSA = -0.20694x107+ C.E. S*+1.00445 acaba 


FSB = -0.4043 UZ OoFOn4) SOoxK10 


meee 15.321 
Bem = 58.51 


FBA = 0.3155 From program 8 
mee = 1.1073 A = 0.80618 

mee = —~32.57 B = 0.48109 

mop = —/73.85 Ga=—wO 1126 

From program 4 D= 0.49365xI0~ 


eOA =-0.31653 
SOB ie 6 
SOC 64.31 
BpoOD =->.076 
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Meain, using N=175 
bs: = (6.68xIO = t -O.07)-*2 
$1 = (-0.103*%t - 0.55 ) x” 
ones ech x12 2+ 1.981 


Nea = ae > 


(85:/ds2) = 0.109 


Then 
Sscom= ds9-( 1-0 Bulk) 
= os2:%) 


maom ene Corresponding root locus in Fig. V-5a, b and 


fot ce = 0.2 - 0.4, | as found Detween 0.34 = 0.64. So, 


0.34 £ enone 4slne kK g 0. Ga 


0.784 5 K DS 0.428 
ene ROL iO 


3. SOPOC and BPOC with weighting B=164, C=0.001, E=0.001 


fmeom Optimal controllers From program 8 
FSA = 0.24 A = 4.0547 

FSB = 0.3459 Bee e757 

FSC = -4.2 Cees oL 
mop = 370.9 D y= Or 015596 


FBA = 0.9705 
FBB = 2.240 


mpc = -—62.6 
map = —-1/73.37 
SOA = -1.0 
mee = —5.9127 


pec = 193.24 
ped = 700.3158 


\O06 





with N=175 
S51 =(0.216-t + 2.46S)-X2 
Mee o.104.t - 1.9) )-*2 
d5, s(o.61g-t 4.249) 2 = -O.49-t-1 (x2 2-02) 
as | eno 
vos (| Av 


is.) 
Seq Jov + 73.56 


BOX C amor z=0.4, the root locus (Fig. V-6a, b) gives 


W\) = 0.035-0.092 


Then 
Oscom = oer (- 3.568 52-352) 
= ds2(i- 4.36 -K | 
0.035  1-K + 4.56 a 0,092 
0 


965 a =K > 4.56 x 0.908 


G21) > K » 0.200 
.85 f X { 0.389 


feeoOPeG and BPOC (B=164, C=0.001, E=0.001) with the same 


© 


Blosed loop C.E. 


peom BPOC 

mos = 0.24 
fos = 0.34592 
moe = ~4.200 
mo = 370.9 
FBA = 0.97051 
FBB = 2.240 
mae =—-62.6 
eo = —173.37 
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Smee trom program 6 


a + 742597 4 3.644387 ieeoreeojor OO 15405 


meen program 4 
SOA =-0.98777 
poe = 668.35 


SOC S57 ..2 


Sob = -22229.8 


neem Drogram 8 


A = 4.543 

B = 3.6345 
mee 1.3713 

Bee 0.015405 


Again, d$1=#0216-°1+2.4659 
SS mone te oe 


ete, On Se. 
Also, O522 9.62:t +497.3 


=~ 0.007 


and Os: - 
aoe OV 


From the root locus (Fig. V-7a, b) and for 4 = 0.2-0.4, 


Mm] = 0.12-0. 22 


Tee 7 t= k= 0993 2 0.22 

0.886 SS K > 0.785 

0.066 / xe Sees 
< L 
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meemoOrOec anda BPOC with weighting D=3000, C=10, E=1. 


feom Optimal controllers 


moe = —0.030196 
FSB = -0.25864 
FSC = 24.688 
FSD = 67.0746 


FBA = 0.31478 
Beee— 1.13873 
Bee@e— ~31.983 
BBD = —-/3.249 
Bee = —-0.31623 
por = ~1.7/7386 
Boe = 57.59 
epee — 165.97. 


From program 8 
A= 0.81664 


B = 0.49528 
me 0.10839 
D= 0.49318E-02 


Using the above, 
834 S (o.n44-t +O, 124)-XQ 
ds2 = (0.012851 -279 )-x2 
Bret = ( 0.132-1 + 0.190)-xQ 
Som Oag°& —0.576 


Then 
rau = 0.417 


dsi\ =-A.LE 
.. 
asco = d32 % K(-A.1G OS -5s2) 


= d52:(1- 2.16 K)=M\- 552 
Paom the root locus (Fig. V-8a, b) and for i. =20..2=0..4, 


Ml = 0.3-0.6 


tog 





Then 


0.3 ZL  1-2.16 K ore 
0.324 > K > 0.185 
1.293 < x g 1.84 


feeeeooOre and BPOC (D=3000, C=10, E=1) with the same closed 
goo C.E. 
Paom BPOC 


mee = ~0.030196 
Poer— —0.25864 
moc = 24.688 
FSD = 67.0746 
FBA = 0.31478 
mee = 1.13873 
mee — —31.983 
PBD = -73.249 


imeem Drogram 6 


C.E. = S$* + 1.15728? + 0.655278" + 0.17872§ + 0.018267 


From program 4 


SoA = ~1.1713 
moe — —120.9616 
SOC = -148.4758 
BOD = 5606. 32 


From program 8 


A = 0.95901 
ee 0.64553 
me=- 0.17872 
Be— 0.018267 


ke) 





Beain, O54 Goi uae eae x2 
Of meena g! +O. 120) - x2 
= =O), \OISSe Sepaae 
Yau = O.4I7 


Also, A52 = (= 2 62-§ -83.9)-xX5 


i 


Os 3 
and ee Pei < 'O >» dscom = 882 (4 -1.00TA1X ) 


O52- ). 


i 


fPeem the root locus (Fig. V-9b) and for iC =0.2-0.4, 


| = 0.46-0.63 


0.536 > K - 0.367 
O71 C x . ieee 


It was not expected Bete use of the previously, almost 
heuristically found values of exponents would result in each 
case in "best" response to impulse inputs. Only for the 
controller using weighting B=800, C=10, E=1, simulations 
were done for the stern only mode submarine to find the value 
of ™\ in the order M352 that would result in "best" 
response. From that point, the condition © = 0.2-0.4 was 
arbitrarily used in the rest of the controllers, although from 
the corresponding root loci distinct differences in the posi- 
tions and movement of roots are apparent. 

If the results would approximate that of the simulation 
in Chapter 4, it could be said that the best value of the 
exponent is the one that corresponds to a stern only mode system 
With order M-ds9 Pie eetakinag the value tesulting to the 
better response of a stern only planes submarine to an impulse 


input. The form of the order allows smooth switching, but the 
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only thing that determines the value of the exponent and can 
result ina different value each time, is the design of the 
separate controllers in CMC. 

For easy comparison, the ranges of X variation for each 
case of controller, derived in that section under the assump- 
tion of linear relation of the form 5} = \ S52 , are incor- 
porated and shown encircled in Table IV-10. Furthermore, the 
above analysis indicates that using the relation Sy eel 


in an inverse way, then: 


Bscom = Kou (HSH = dof xy LK] 
r\ 


SEOs | aC Peon a. 


The above suggests that a controller having Sscom = dsi-fa K+8| 
for Ke could be equivalent to the proposed CMC. This con- 
troller will not make use of a separate stern only mode design 
but there will be some difficulty in defining the values of ad, 
mee The parameter M,will depend on the specific design of the 
BPOC and the specific submarine. 

To demonstrate and check the above, root loci for Osi ™ 
were plotted for the three BPOC (Fig. V-10). 

For the controller B=800, C=l10, E=1, “\y is selected from 
values that it is expected to give roots satisfying the cri- 
eerion of dominant complex pair. 


Then 


i 
© 
iS 
i 


My 
Mu. 


N| Lower 


1 
NO 
bs 
T 


|, UPPER 


vp 





or an Cee rt U 


For {\ = -4 panes from the ratio = = -0.245) 


found before 


(q.x028\-4 L : Lu +025)- E 
x 


o for K as before the average (0.433) , it is found: 
oq\ (Mit. 95). dogl (M+ 0-25) - 4] —_ > * — Qog\Mu rO. 95\-4 x | 
- Oo. 433 €og ©O.43% 
and 


0.781 > X » -0.755 


Thus, the control order to be tested will be 
0.4346 
Sscom = Osi | 4.25. oa Pe =) - 2.25 | 


Values of X between -1.0 and 0.75 were tested and the 
results are shown on Fig. V-1ll to V-14. The submarine 
responses are acceptable. Numerical results are collectively 
presented in Table V-l. It 1s seen that the maximum depth 
overshoot with X = -1l is lower than any one achieved with 
the previously tested CMC schemes. The controller has the 
same degree of generality as the proposed one when the expo- 
nent X is fixed to a specific value. 

mes Tunctioning effectively only with a specific system 
of submarine and controller and already failed when tested 


with BPOC having B=164, C=0.001, E=0.001. 


ee EVALUATION OF CMC 
The conclusions concerning the proposed CMC are: 
a. It functions satisfactorily for certain designs of the 


separate BPOC and SOPC or SOPOC that compose it. 
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b. It is desirable that Osi Pes eOoC we sused in a SOPC 
as the order to the planes, will result in a stable submarine. 

c. In the cases of satisfactory operation there appears 
to exist a relation between the orders Asi | Os2, which also 
can result in a specific "optimal" value of X, not necessarily 
ORD. 

d. In any case, the CMC using BPOC/SOPOC or BPOC/SOPC 
(same C.E.) schemes may not be the near surface optimum one. 
As for example, when in one of the simulation runs (BPOC with 
B=800, C=10, E=l and SOPC with the same C.E.) the value of 
oa in Os2 was mistakenly written 5.056 instead of the correct 
50.56, the resultant submarine response (Fig. V-15) was much 
improved compared with that corresponding to the correct value 
(Fig. IV-44) ! 

The last thing that was examined was the possibility that 
for a given submarine, use of optimal theory for a BPOC and 
SOPOC would always result in the same relation between Osi 052, 
possibly a linear one, independently of the values of the 
weighting parameters. 

Pwcombining f£uncecion of the proposed form could then 
have elements of generality, at least for a family of 
controllers. This general relationship doesn't appear’ to 
exist when the optimal design is closely examined. 

The steady state solution of the matrix Riccati equation 
can be found in terms of the eigenvectors of the 2n x 2n 
partitioned matrix M = A 





Bae eigenvalues and corresponding eigenvectors of M are found: 


where the subscripts denote the signs of the real parts of the 


eigenvalues, and the corresponding eigenvectors are 


“B- | 


ua is partitioned and the solution to the problem is 


a -1 
te YB 
Maeeeclationship between the values of K's in the two combined 


Mentrollers is a function of B ra Ee Of the controllers, if 


Oo 
Pee are kept the same. (S7O>P Orc has 2 =| , RC » 
B12 
oS, oe Ce 
@ePeOne whas O= |c) |, a-[ ve 
oO ¢ 
G2 Bag 


meee this is the only term that changes in M. 

ioe OmancdeR ane changed, resulting in another set of 
optimal controllers with new weighting factors, it becomes 
evident that only by chance could the same relationship be- 


tween S O POC. and BPOC be found. 


eS) 


















Maximum Depth iescEmum P2 Geh 
xX overshoot( ft) ———-. 


a 
alee pepe paar | 
a CE 
Ep far Peano eee] 


Time to positive 
peak(s) 











TABLE V-1 


PAitleumrom mresules of thie application of a 70 ton x 10s 


pulse force at the forward trim tank.The submarine was 





Sfcom 


Beetrin” and the controller had Oscom=0s1-2125- oes 038} 
ema B=800. ,C=10.,E=1. 
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VI. DISCUSSION, CONCLUSIONS AND RECOMMENDATIONS 


The problem of optimum near surface control of a submarine 
is relatively new and not an easy one to solve. Much of the 
experimental data that would help in gaining a better under- . 
standing of this subject has been classified. Optimal 
theory has made the setting up of a large class of optimal 
control problems almost routine. Again, this is not the case 
here. 

Inequality constraints on the control variables suggested 
approximate methods and exact approaches for the solution, with 
which the author was not familiar. 

It becomes necessary in a number of important fields of 
engineering to devise controllers for plants which exhibit 
very substantial changes in their characteristics, due in most 
instances to a changing environment. Such a devised controller 
was tested and analyzed since design of the optimum near sur- 
face control system would require both the classified experi- 
mental data and advanced knowledge of optimal control theory. 

The proposed scheme of control order for use after the 
Saturation of the forward planes introduces, in fact, an inten- 
tional nonlinearity, modifying the system characteristics. 
ime theory of intentional introduction of nonlinearittesinto 
the system (linear model) is still decisively incomplete. A 
Suitable approach is not evident for a straightforward analysis. 
A more extended examination could perhaps include describing 
function methods, phase plane description using a second order 


model or even consideration of the minimum time problem. 


ALT 





As K appears in dscom , it is a variable weighting factor 
that in a way selects corresponding parts of the Os} and 0s 


orders, after the forward planes are saturated. Because of 
d$max 


x 
the way K is defined, l.e. K = Pesass | fOr 
mee) 


kom Ofmax , its values of interest range between 1 and 0. 
mne value of corresponds to either a value of Of Max 
infinite for small values of X, or to a large value of 


x ( ao = 10°), depending on the value of the ratio orale ; 
atcom. 





For a stabilizing controller, dfcom after saturation, is 
expected to take values in a limited range. The exponent X 
directs or scales the value of K somewhere in the region (0,1). 

There is no indication nor even possibility that an expo- 
nent X=0.5 could automatically result in a value of K select- 
mir the right proportion of As4 and O52 orders, to obtain 
the best response for every given controlled submarine and to 
any inputs. 

The simulation runs show that even if the value of X=0.5 
results in an order Oscom which satisfies criteria of "opti- 
mality" in response to a certain input, changing the input 
will reveal disadvantages in other respects, which could be 
softened by another value of X. 

The submarine is already a nonlinear system. It may behave 
quite differently with different input functions. The pro- 
posed controller was tested for a limited number of step and 
impulse inputs at a constant velocity. The logical design of 
a nonlinear system requires a complete description of the 


input signals. 
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As demonstrated in Ref. 6, the design of a linear system 
to minimize the mean square error with random input signals 
requires a knowledge of the second probability distribution 
functions of the signal and noise components of input. In 
contrast, the design to yield the nonlinear system which is 
optimum on the basis of the mean square error criterion 
theoretically requires knowledge of all probability 
feese ri butions. 

To the most elegant design problem, involving the deter- 
mination of nonlinear elements appropriate for insertion in 
either a linear or nonlinear system to improve overall dynamic 
performance, perhaps the major difficulty lies in the problem 
of phrasing the specifications in a form amenable to analyti- 
cal design techniques. The marked dependence of the perform- 
ance characteristics of nonlinear systems on the particular 
input Signals means that in general the specifications must 
include precise description of input and desired output. For 
the specifications developed during this work, the most prom- 
1sing scheme of Combined Mode Controller appears to be the one 
that combines two separate optimal designs. It is then prefer- 
able that O$1 also corresponds to the order of a stabilizing 
Seern Only Plane Controller. 

The exact tracking controller can also be used in the 
Combined Mode Controller. 

The Combined Mode Controller can be tested under a ficti- 
tious seaway Simulated by the parallel application of step 


and sinusoidal forces. 
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Finally as an alternate solution, a model reference 
method can be worked. In that case, an improved linear 
model is required. The model can be used in an stochastic 
estimator which will provide the necessary decision logic 


to modify the controller parameters. 
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APPENDIX A 


ON LINEARIZATION 


In Appendix — the general equations of motion, given 
in terms of a set of axes fixed in the boat, are repeated 
from Ref. 1. These are six nonlinear scalar equations, 
representing the components of dynamic equilibrium in 
each of the six degrees of freedom. Also, six additional 
equations, relating the motions of the boat in body axes 
to the orientation and motion of the boat with respect to 
fixed axes are given. 

The above mentioned set of twelve nonlinear equations, 
characterize the submarine and are sufficient to determine 
its response to an arbitrary set of time dependent forces 
mia moments. Where only vertical motions are of interest 
considerable simplification may be achieved. Although 
this constrains the applicability of the results, somehow 
the constraint will not be too severe, since submarines 
spend the vast majority of their underway time traveling 
on a straight course between the proverbial points A and B. 

Further, for the class of problems in which the sub- 
marine perturbations from equilibrium are small, the equa- 
tions of motion may be linearized and thus lead to even 
greater simplification with acceptable accuracy. 


Av 





Basically a Taylor's series expansion of all variables 
is made about an equilibrium condition. After substituting 
these expansions into the equation of motion, terms of 
higher than first order, are omitted. For small perturba- 
tions about the equilibrium condition, the actual equations 
are very closely approximated by the linearized equations. 
As the magnitude of the perturbations increases the accuracy 
of the linearized equations is degraded. 

The equilibrium condition used, will be for the sub- 
marine traveling horizontally at a steady speed and with a 
steady pitch angle (assumed zero for simplicity). As part 
Seeehe equilibrium condition the ‘in trim" condition of 
weight and longitudinal center of gravity is included. 

The initial reference values of all the variables are 
denoted by the subscript i and the small perturbations are 
indicated as follows: 

- changes in U, V, W etc. are indicated by small 

letters, i.e. 
Oe ak. p;tp, etc. 
- changes in control surfaces are denoted by 
83 , db dr 

In this paper the submarine is considered as a rigid 

body and in Appendix B, derivation of the required equations 


from first principles is presented. (Ref. 9) 
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The kinematic and dynamic equations of motion derived 
in Appendix cmcmcemece tedupelow [or ready reference. 
The XZ plane of the coordinate system is taken at the 
plane of symmetry of the boat so that 

Toe = Tyy =) 
Then 
X = M(U+QW-RV) 
Y = M(V+RU-PW) 
Z = M(W+PV-QU) 
, (1) 
K = T,P+QR(1,-1,) 
M = TQ+RP(I,-T,) 


eee lei) 


The details of linearization of equations for Z,M,X are 
carried through. 
The hydrodynamic forces and moments depend on the 


orientation, configuration and motion variables. Thus: 


Z=Z(U,V,W,U,V,W,P,Q,R,P,Q,R,e ; a7 ge po cee) . 
X=X(U,V,W,U,V,W,P,Q,R,P,0,R,6,%,¥,0s ,Dr,Db). (2) 


M=M(U,V,W,U,V,W,P,Q,R,P,Q,R,0,9,%,0s ,Or,Ob). 


For steady equilibrium the reference values of the variables 


are taken as constants. Making the appropriate substitutions: 


ae 





- me HOt P) (viev) -(Qi+Q) (Ui +U)| 


3 
7 


lyq +CrierCqir+Q)Cly-Tx) C3) 


ms 
ll 


mLY +(aitQ)(wire)- Cre \Oiv) | 


where Z,M,X are given by: 


ZL = Z(ursu, ieee ia . Db+db ) 
Mee M( Ute, V\4V,------.. Dbrdb ) (4) 
Pee XC Nit DbWb ) 


The Taylor expansion of Eqn. (4) is 


2 
2 | (UDu SiO -OUDS, | {udu wOv + pds) a r- Sou) +H,0;pn-5) 


a 
M at (udu &vVDv + +O Ddy) + (dur Drs db Dy oT|mfan-39 
3 as 


x at s(udus VDv+ syne rays Dd ) ae (UDu + Vv Dv Te SbD db. 1.0.7 x(Lins OH) 
2 | 
(5) 


Since we are dealing with small perturbations, from the 
equilibrium condition, the second and higher order terms 
may be omitted, leaving only the first two terms of each 


Mie tne above series. 


et 





Writing the D operators in their partial derivative 


notation 
Z = Z(Uwvi.. Ob) + uR2t oa tee gt ae, 
i M (ivi, 80) \ YOM}, vO + so (6) 
Pex (ois, Ob) + vee, 2 ve eee Eo 2% |, 


where the subscript i denotes that the partial derivative 
is taken at the initial equilibrium condition. 

The use of only first order terms, implies that the 
forces and moments vary linearly with the disturbance 
variables for small enough disturbances. 


On substituting Eqns (6) in Eqns (3) one obtains: 








~~) oe 
a 7 a. =: me “CreP ws) Breyer] 
DM ee wie eet: \ = ya xr(ti+ erp) (1 -Ix) 
Mi ey lv + ee i yorum) , 
Peo Ox | 4 y Us eens \ =m\U (aro ieed orien) | 
i Salk : Ov SB ’ Ode \" ™| ‘ 
cy) 
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Bence 2. , M,, X; are equal to the unperturbed terms on 
the right hand side of Eqns. (7) respectively, they may be 


cancelled out. Retaining only first order terms and 


Peteang Z,, for etc. gives: 


We + ZyV + 2y Wt Wey EV 2 Ee Ww ES, tL + ZyV + G24, + 
D2po my 2 +© Zo ie +WW dwt ds Zs, + Oy Ga Oe ie. = 


m(@-GiU-q Ui r Div+pvi) 


oom) XV e Kew Kou + Kem a) E(x moi) w eked + 


Ka + Xr +X pps CXAY-Mrjg zr Keamvilry Xo sxe O + 


Boe + X84Ob + Xs, 83 + KNOY SO 


(8) 


™MgQ, Fp + Me + tM + Mod + Moy + 15,0 s +™ 5 Sb+Ms,0¥ = 


lyQ «(rt prroi) (Iy-1x) 
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For the straight, level symmetrical travel, these 
equations may be considerably simplified. 

For a truly symmetrical boat it is clear that the side 
force Y, rolling moment K, yawing moment N, and rudder 
moment are zero. Thus the derivatives of the assymmetric 
moments and forces with respect to the symmetric variables 
ae W, Q,ar 6 are all zero. 

Furthermore, v;, Py, dq» %y,9 4 are equal to zero.Since 
we use stability axes oi =0 and U; is the reference boat 
BpeedW,. Since we are considering level flight 6,;=0. In 
addition the following approximations are made: 

1. We may neglect the derivatives of the symmetric 
forces and moments X, Z, M with respect to the asymmetric 
variables V,P,T,6,0+ 

2. We may neglect all the acceleration derivatives 
except Zw, Zq, Mw, Mq. When the above simplifications are 
made, the linearization of Eqns. (1), for calm sea operation, 


results in 


(mn O- Xu) uw = Xww -[Xa,D+Xe [@ =0 
-2o\4 4 (o1-Zs) O- Ze for-[25 0 +(Zyemve\D+20|0-Labs-Zad 


ID 


Vw ON 


a= (Mode Maw +(Ey- mg] O- Ma,0-Me Jo-Meee Mg 


wei 





Also 
a=6 
(Depth) = W - Ve 9 


The above equations are now compared with the corre- 
sponding Equations of Ref. 4 and those of Ref. 1, where 
linearization was accomplished by dropping all nonlinear 
terms. To make the comparison easier the equations are 
written in similar form. 

I. Derived 
( m-2e)@ - 25 = Zw + (Zar Us) G, + [ZULU +ZeO]econktoe forces 


= Me GO + chene) \o) = My WD + May 4- PMa is MeO | FCONttCE?e LOCces 


Mime keterence | 


(m-2a)e-€ 24a = Ss ieee PAO COD 6Se FOYCeS 


{ 


es ‘ Clee, = S ae Ma +Con 110€ fences 


ieee Reference 4 


™-Za)@ -Zaa = Zea +CZa+em)oa,+conliroe fovcey 


-MoO + CLly-Ma)a=Mew+ Maq+ Mod +con bro torcey 


Except for the fact that some equations make use of 
dimensionalized and others of nondimensionalized coefficients, 
the terms in the equations are almost identical. 
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The hydrostatic restoring term "\s@ appearing in the 
set of equations in I and II above, exists because the 
introduction of a pitch angle @ on a submerged submarine 
results in the creation of an hydrostatic moment Sl , 
equal to 67- AO in ft-tons, opposing that angle. 

This gives rise to an “\g@ term in the pitch equation 
having a nonzero value. The ways that the existence of 
“\,9 influences stability in the vertical plane are 
defined in Ref. 4. 

In the nonlinear equations of motion about the Body 
Axis System y-Axis in references 1 and 3, the term appears 
as Bz sin@ and is neglected during the linearization pro- 
cess of reference 1, although it could have been included 
as Bz-G , since small angles are considered. 

The terms Z,0 , Zu; Mu do not appear in reference l 
or in 3, from where the nonlinear equations were originally 
Seen. Finally, the term muq (or mi,q) is neglected in the 
linearized model of reference l. 

This thorough, yet not complete, investigation of the 
already derived and used linear model, was soon justified, 
when the realization in the form of simulation of the 
design of the stern only planes control system was attempted. 
Initially the model of reference 1 was used unchanged. 
After a few tests it became apparent that the model was 


insufficient for the present purpose. 
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The term 'muq'’ was included in the equations without 
any improvement in the simulation results. 


Use of the linearized equation 


/ 
(Depth) = w - u-9 instead of 


I 
(Depth) = w which in fact was 


used when the original vector (3 was rewritten in the 
a 
Setce f£Orm | \, , gave acceptable results in the respect 
Xs 
Ky 
of the linearized model mathematical representation and 
simulation results. 

Insertion of the term Bz:9 was not considered in order 
to keep the linear model as simple as possible and because 
a constant speed was used in all test runs. 

Details on changes due to the application of the 
described steps are given below for future reference, and 
Lor a constant forward speed of 15 knots’ (25.33 ft/sec). 

1. As already mentioned, in reference 1, the problem 


was initially treated as a linear tracking problem. The 


state equations were: 


x =A x+Bu, and the performance measure to be 


minimized was: 





r= ve(x@d cA Hx) oO + 
af it (4) @)] Q | x@Qccj+ Uy uO Lar 
Xo 


meme XY represents the ordered depth and pitch. 
The following approximations were also made for small 


perturbations: 


state variable form of equations 


- 


xy 0 iE 0 0 xy O 0 
. De 
Xo O Ayy 9 Aggy [x2] [Bit Bay 
; % 7 Dy 
Xa O 0 O i Ky 0 0 | 
where 
x, = Depth 


oa Ky = Rate of depth change 


oe Paeeh 

a = es = Rate of pitch change. 
Lora 

sine =f = Bove for the command inputs then 
© 

x, 7 ae aa epen Error = By 


es 








Depth rate error = E., 


Say 1 ae PEeen error > BE. 


a Pitch rate error = Ey, 


and the performance measure became 


§ 
5 = 1 | (EQEruUR@ujat ( for H = 2 | 
to 
ewso: | E, 0 a 0 0 Ey 

Fe} f° An 9 Ag | Ee] Dee 

Ey 0 0 0 i E, - —b 
i 

Ey, 0 Alo 0 Ay9 Ey, | 


ealepe 


The optimal solution U=-R B KE in the simulation 


program of reference 1 gave the equations: 


DSAD 


Yi 2OER ENQi-2ODOT/U AN 31 - PERRE Yai. Pinot /u 


DBAD mE 9 ZOER+ gq ZONST/U tee) PERR+¥a1- 01 mOT ie | 


im the described model: 


nl (Gy: 20H 26) Mw |. Vee a= =4).3769% 10°? 
a Ca Ee 
ATE AEC 
Ayy7 | REE -Zq + Ate Male |u Lea = -6.2278 
L ieee 7s Pee eS aa = -4 
427 | ( 2\ 2 “ea | S 4.7727 X10 


ACE icc 
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Agg™| ace 29 t ace -Maje |, UW - ny = =0,15443 
B,147 | AEE Zos agree Ue | Ue ALA = -0.42783 
By 97 | ACE Zos + aes Cp Jule Inv eEGW ocho! 
Bp y= | AEE “Zoo* AEC ge [le Low = -0.24839 


D OVABE SNS = 


7 Pee OD as ce, 
Boo= face on ane U/e In 
Pym iny = ACC-AEE - ACE-AEC = 6.3713 ¥ 10° 


2. If the term u-m-q is included in the equations of 


meme Linear model then 


7.4422 


= 

am. 

a 
ll 


A,,= (AEE*(Zq + M) + AEC* 


0, Maes 


oS als 
o 
4 
a 
I 


—— 


cee Lt the term BZ-@ is included then setting Bem : 


(BZ=B-Zp) , then 











, at | 
w | |M-zw 0 (.Zq U. Zw 0  WU(Zq+m) wo 

| [4 
e |=! o i O O O i pyc 

| | ret | 
q | | -tMw O Iy-mq| | tw BG ssi q 

J | 9? t. 

hoe 





M-zv «=o -Bezq | | WeZds = UZ 
g va 
ds 
O iE O 0 
+ db 
-Mw 0 il -Mq | u2Mds u2Mdb 
a y eeu oe, 
¢ e 
and finally 
BG-@-zq f 
. sel Determ "21 | i a a ia 
ds 
9 0 ik Sy ee, 
0 0 db 
° BG « (m-Za) 
a Er Determ S22 1 | aD e22e 





where Determ = (M-Zw) (Ly-Mq) -Mw-Zq = — 
INV 
ari 
3743 x 104 


feed, 4971, 419, 497, Bi1, Bo], Bio, Boo have the same 


mearues as before. With BG =2.44 x 10° then 


a ee = 0.0013 


R - BG-(M-Zw) _ 0.0025 


Determ 


To study the effect of the changes in the values of the 
Eeemients Of matrix A, the eigenvalues of the plant matrix 


were found and are given at the end of this Appendix. 
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iemcmieck for controllability the third order system 
(w,@, q) was decoupled using linear transformation. 
Kalman criterion was also used. In all cases the plant 


was shown to be controllable. 


a. Original A matrix 


0 en 0 0 
0 -0:.43769 E-O1 0 Ona 
| O 0.0 0 eee. 
0 0.47727 E-03 0 -0.15443 


Kigenvalues 
Wee. 0.0, -0.89659 E-O01, -01038539 


PeeeMatrix A after the addition of "“-u-90" 


0 a0 oe oo 0 
0 -0.43769 E-O1 O20 =O92 276. || 
0 0.0 Cee iO 
0 0.47727 E-03 O20 -0.15443 


Eigenvalues 


Same as above. 


In the state model used in that paper the above matrix was 


Beupstituted, 


V2)5 





Original matrix A with terms "m-u-q'' added: 


=~, 


0 eee 0 0 
0 -0.43769 E-O1 0 7.4422 
0 CEo 0 ire) 


0 Oey 727 B-03 0 -0. 16123 | 
| 


Eigenvalues 
Peo, 0.0, -0.18826 E-01, -0.18617 


Above matrix A with term "-u-0" included 


0 1 SZ oo 0 

0 On 4s) 769 er-OL 0 7.4422 

0 0.0 0 ee) 
0 Gea 7727 E=035 0 em 


Eigenvalues 
Geo. 0.0, =-0.18826 E-O1, -0.18617 
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APPENDIX B 


DERIVATION OF EQUATIONS OF MOTION OF RIGID BOAT 


l. Rigid Body Equation 


In this Section the submarine is considered as a 
rigid body and a derivation of its equations of motion 


from first principles is presented. 
From Newton's second law, the force F acting through 


the center of gravity c of the boat, in vector notation is 


ac (1) 


where m is the mass of the boat ae its velocity. The 
moment of the boat G is equal to the time rate of change 


of its ngular momentum and is given by 


g =a (2) 


where the angular momentum h is, in terms of a particle of 
mass dm located a vector distance r from the center of 


peevity. 


h = ie r x(U, T= WSlgase 75) dm 


13] 





where the integration is taken over the whole boat. Since 
U is the same for all particles and { © dm = Q the above 


equation becomes, after expanding the vector triple product, 
he {[o Gz) -7@x)] am, 


Let r and ® be expressed by 


—— 


rexit+yjtak 
(3) 
O=PitQjtRk 


where x, y and z are the scalar components of r, P, Q and 
R are the scalar components of Ww and ce] and k are unit 
meetors in the direction of x, y and _ substituting 
these expressions in Equation 3 gives for the scalar 


components of h, in terms of the moments and products of 


mmertia A, B, ... F, 
a = I. P - Tey Q- ae R 
hy =-Ixy ae Ty Q- Lye R (4) 
oles a lye Ole 


1a11 rotations (control surfaces, angular velocity 
components, etc.) and moment components are positive 
according to the usual right handed convention; i.e. from 
Ene x-axis to the y-axis to the z-axis to the x-axis. 


where 


2 2 
LS [oy See) ecu lye = J yz dm , 
rT. = F (2? + x2) dm , er [ 2x dm, 
lS Sf a y*) dm, and Ixy = ; avan CliIts 


If , y and z are taken as the coordinates of dm in a 
non-rotating frame of reference, with origin at the center 
of gravity of the boat, C, then it is clear that in general 
the moments and products of inertia as well as the angular 
velocity components P, Q and R will vary with time as the 
boat rotates. This is an unnecessary complication which 
can be avoided if the coordinate system 0 x y z is fixed 
in the boat and allowed to rotate with it. Though this 
introduces additional terms the resulting equations are 
much simpler since now the inertia terms will remain con- 
stant. Thus Equation (1) becomes in terms of the velocity 


components of U, (U,V,W) and angular velocity © 


F 


d za a re 
eer = W 
m Che yj k) 


2 | P+¥j+wi +wdisvdew a, | 
: 


7  ——— 
n\S% 5x Te | (5) 


since S* = po OL = Gox j and $= 





Cy 
6 
os | 


The 





9 


operator ras the definition implied by Equation (5). 


Similarly, Equation (2) becomes 


3 


a | 


G = eG (6) 


QA 
ct 


Combining Equations (5) and (6) with Equation (3) gives for 


the scalar components of F in the i, J) and -kacarec tions 


us =m (U + QW - RV) 
at Caen ee ew) 
F, =m (W + PV - QU) (7) 


and for the scalar components of G in the ae j and k 


directions 
K=h,+Qh,-R hy 
M=hy +Rhy - Phy (8) 
N=h, +P hy - Q hy 


Equations (7) and (8) are the Euler equations of motion of 


the submarine. 


3. Motion of Boat Relative to Fixed Coordinate 
Solution of Equations (7) and (8) gives the linear 
velocity components U, V, W and angular velocity components 


P, Q, R relative to the 0 x y z axes fixed in the boat. To 
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obtain the motion of the boat center of gravity it is 
necessary to express the linear velocities relative to a 
fixed coordinate system. 

We therefore define a fixed orthogonal coordinate 


system O x Wig, pibelover slg ented ayo 


O 


0 Yo 2, im which the x 


parallel to the equilibrium plane of the free water surface 
and the Zo direction 1S positive downward. The orienta- 
tion of the boat axes (x,y,z) relative to the fixed axes 
eyo: 25) 18 shown in Figure B-1. It is assumed that 
at first the two reference frames are parallel. Then the 
orientation of the boat is determined by considering the 
following three rotations, in the order indicated, where 
all rotations are in the positive direction. 

feeesotate the x,y, axes about z, through the angle of 
yaw ‘P to the position (x ,,y}). Then the direction cosines 


between (X5,Y9,Z5) and (x1,y 1,21) are given by 


Ay all 21 
me cos ¥ -sin | 0 
a 0 O i} 


Mads a vector x7 i yy hq + z1 ky in the x1, yj, 2] 


System has the scalar components 


LAL 





Xo = xy COS; = ih sin W 


a Sd 
Ky sin V Ys cos 


< 
O 
il 


fieene (X,,¥,,Z,) system. Expressed in matrix notation 


these equations may be written as: 


Ss cos -sinY 0 Xy 
Yo 2 sin ¥ cos ¥ 0 Yy (9a) 
i “0 | Nee 0 Ly ie | 


Thus Equation (9a) represents the first rotation. 
ii. Rotate the (x,,2,) axes about the y, axis through 
manele of pitch © to (X5,Y9,29)- This may be expressed 


Miematrix notation by 


Ry cos 6 Q sin 9 X9 
Z| sin 3 0 cos @ | | 2 
I 


iii. Rotate the (y5,Z5) axes about the x» axis through 
an angle of roll o to (x,y,z) the actual orientation of the 


boat. This may be expressed by 
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Ko ii 0 0 »,< 
Y9 = 0 cos® -sing y Cue) 
25 | | O sin® cos | Zi 


Combining Equations (9a), (9b), (9c) gives for the resultant 


memati three rotations 





x | | cosy -siny 0 ccs 8 O sin Q | 1 0 Or ec 

el sinW coswW 0 0 il 0 0 cos -sing| ly (10) 
| 

Eo. 0 0 iL !-sin 9 Q cos a QO sin® cos] |z, 





By carrying out the operations indicated by Equation (10), 
the direction cosines between the y,y,z axes and the 


X .% .Z axis are obtained. These are tabulated below. 


me y | | Z, 


-cos® sinW sind sinwy 


X, |cos 9 cos¥ | 
+ sin 9 sind cosy a sin 8 cos® cosw 





-sin®d cos VW 


Yo (cos 8 sinY| cos@ coswV 
+ sin @ cos® sinw 


+ sin 9 sing siny 


Z aeons cos 8 sing cos 8 cos} 


Resolving the U, V, W velocity components in the Ky 2VG 2% 
directions gives for the velocity components of the center 


of gravity of the boat in fixed coordinates 
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a pe eee owe cos UV (sin 6 SamevmeCOs COS 7 sin) ) 
i Perms iiwes sine Cosd cos) 
d 
-- BeUmcosmoncEmM VY V (cosa cos) + sin @ sing sinw ) 
ie 
Pee (seumecosa sini) = sind cos ) 
d 
=- ooo yecos oO sim = W cos 8 cos dé (11) 
ieeobtain X, Yo Zo from integration of these equations, 


as a function of time, in the most general case would 


clearly require a very considerable effort. However, for 


most problems involving the motions of submarines these 


equations may be considerably simplified. 


4. Angular Orientation of the Submarine 


The angular orientation of the submarine (86, 


b,Y) may 


be expressed in terms of the angular velocity components 


(P,Q,R) by expressing the angular velocity of the boat in 


terms of the angles (0,),W). Thus the resultant rotation 


of the boat from orientation (8,9 ,W) to orientation 


(8+d9 oO+do,ptdv) in time dt, using the same order and axes 


of rotation as in the previous section, may be represented 


by 


dQ = (¥+ dy) k. + (o+d0) - + (@+d$) i! 
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where the subscripts indicate the axes along which the unit 


vectors i , my and k are taken and ij, anced == 1 as 


dt — 0 


and 


Resolving Yk, and 9 se along the body axes x,y,z by the 


use of Equations (9b), (9c) and (10) gives 


bd -W sin © 


@ cos oO+w cos 9 sino Gis) 


iB 


Q 
R= Y cos 9 cos - 6 sind 


Solving Equation 13 for Q, db and gives 


8=Qcosd -R sind 
b=P+Q sind tan @+Rcos@ tan @ C14) 
Y = (Q Site@us 2 CoS @ ) sec O. 
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APPENDIX C 
INVESTIGATION FOR VALUES OF WEIGHTING 
FACTORS IN THE COST FUNCTION 
A. STERN PLANES SUBMARINE 

In the design of the optimal controller for the stern 
nes only submarine, one of the problems faced with was 
the proper selection of weighting parameters that would 
result in the desired submarine response. At that point 
the idea of setting the submarine "in trim’ had not been. 
considered yet. So, when the values C=10, D=3000, E=1, 
taken from Ref. 1, were tested, the resulting gains and 
finally the controller orders failed to keep the submarine 
at the ordered depth. 

A laborious trial and error procedure gave unacceptable 
results. The need for a more systematic search for the 
proper values of the weighting parameters led to the method 
described below. 

In short, this method uses linear feedback of states 
and the closed loop CE for root placement at selected 
positions. Then a linear system of equations is formed 
from corresponding relations in the optimal design and the 
Simple state feedback design. Solution of the system 


Pives values for the unknown factors. 
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The problem is not solved exactly but the method helps 
to indicate magnitude relations between the factors and 
range of values from which they can be selected. 

The solution to the linear regulator problem gave the 


optimal control law 


-1 
U* = -R Saye Kene nas 


where ae =O) C2. Or 


Us = -CI | 0 By 0 By|* /Kyy Kpy Kg) Kay 
Ko9 
Ki3 Koz Kgq Ky | 


Kou 


Petere Tor simplicity B,,, Bio were replaced by By, ewe 


Then 


i : : . t ; i t 
ae By eee 22 2) K32+By “K34! By -Ky2tBg-Ky4 | °E 


: or |F yy For Fy, Far | “= 


Deviating from optimal control methods, the problem of 
controlling the linearized model by use of linear feedback 


of states is examined. Ds is replaced by 





SOA-E. + SOB-E. + SOC-E. + SOD: 
or 2 3 ai 


where SOA, SOB, SOC, SOD are the feedback gains. 


Then 


0 ee Ce) 0 


E=| 0 Ay1 0 ae oe By [Soa-E]+S0B-E,+S0C-E3+S0D-E, | 


OO 0 
mene? ¢ ay Weel 
Or 
0 1 =i 0 
E =| SOA‘B, A,,+S0B-B,  SOC-B, A, #80D-B, | -E 
0 0 0 1 
SOA‘B,  A,5+S0B*B,  SOC+B, Ag tSOD“B, 


To find the CE the following matrix is formed 


S =e be 0 
-SOA*B, S +A, 1 -SOB*BL -SOC-B, ~Ag17SOD-By 
0 0 5 -l 
-SOA* Bo “A, 975S0B-Bo -50C-Bo S -A99-SOD-Bo | 


Setting the determinant of the above equal to zero gives 





s+ + (-Ay1-A72-SOB-By-SOD-By) -S? 


ta Pte) oe OOD? Dotn5 5 7 o0B-By 
-A19*A91-Ayj9°SOD-By,-Ap1°SOB-By | +S 
=50GeB>-S0A-B7 


+ oO Gesu ois | 4 0G Bo 
+SOA-Bj°A99-A9g1°SOA-B9 “Ss 
tU. SOA+ Bo 


+ 


(U+SOA+By1-A12-U-SOA-B2°Aq1) 


= 0 


Ai, = -0.43769 E-01 
Ayo = 0.47727 E-03 

Ao, = -6.2278 

Ayo = -0.15443 

B, = -0.42783 

By = -0.94019 E-02 


The original positions of the plant eigenvalues are con- 
Sidered and new positions selected according to some 
specified criterion (for example selection of a pair of 
relative dominant complex roots with negative real parts). 
The new CE is formed and comparison with (1) gives the gains 


SOA, SOB, SOC, SOD (program 4). 


LAS 





for roots: 


UO o> 


Se 
S9 = -0,51 
5S; in “0.00102 + 10.486 


eZ 


meer a4 St + 0.57524 S-+ 0.2702 S¢ + 0.13533 S$ + 0.77979 E-02 


Then SOA = -0.5 


SOB = -/.03 
SOC = 32.5 
SOD = 360.0 


Gimenworder DSAD = -0.5°ZOER-/ .03-ZODOT+32.5-+-PERR+360- PIDOT 
gave the submarine the satisfactory behavior shown in 
Figure C-1, for zero depth and pitch ordered. 

Another test was made, 
mer roots 


Si = -0.082 


sy = -1.998 


$3.4 = -0.004474j0.0642 


4 . 2 


meer 39 +2.08976 5 +0.18699 S” + 0.0010087 5+0.679973 E-03 


the feedback gains were: 


SOA = -0.0436 
SOB = -3.49 
sOC = 0.0523 
SOD = 360.0 





meas to be noticed here, that even if the values for sj, 
S9, $3, Sy, in the examined cases appear to contain some 
magic relative to their selection, in fact they resulted 
from a limited trial and error circular procedure. The 
path was from roots to the CE, to the feedback gains, to 
simulation, to modification of the gains to improve con- 
troller performance, to new corresponding CE and finally to 
the given values of roots. 

Figure C-2 corresponds to the use of a feedback con- 
troller with the gains found in the second test. The 
results are acceptable. 

Finally for roots s,=0.1, Sar SO pee Oca gO. 0 


4 3 40.33 s* 40.031 st 


omemck 5 +1.3 S$ OOO) 22> Enewea ins 
FBA= -0.0656, FBB= -1.47, FBC= 26.2, FBD= 184.1 were found 
and tested. (Fig. C-3) 

The main reason for these repeated tests was to check 
how well assumptions concerning stability of the linear 
model were valid on the simulated nonlinear submarine.. 

During runs at the speed of 15 knots with both planes 
available, it was found that for a submarine "in trim" the 
following quantities representing ballast, had to be added 
in the three trim tanks. + AT= -6.4 x nome AU= 8.8 x 107>. 


Mie] 6.4 x 10>. 


Ito give weight in pounds the above numbers are 
multiplied by (Length of Submarine) ?. 


ee 





Figures C-4 to C-6 show the behavior of the submarine 
for each of the examined control laws as before but with 
the required ballast added. Judging from the S.S. error 
values the performance of all controllers has now been 
improved. 

The next step was an effort to correlate the results 
from classic feedback control with that of the optimal 
theory. 


For the feedback gains 


SOA = -0.5 
SOB = -7.03 
peG = 32.5 
peop) = 360.5 


mae control order was: 


DSAD= -0.5°E -7,03°E5+32.5°E nen 


1 3 4 


From the optimal law 
DSAD* = ~CI+| Fy Eq+P1 (Et 31 °E3tF yy Ey 
where use of the definitions in main program of Ref. 1 is 
made. 
Comparison of the two orders show the following 


correspondance: 


-CI i Pui — -0.5 = SOA 


= 68 i Poy = -7.03 = SOB 


Se 





-CI - F Boe = OC 
=. aa 86070 = SOD 


This gives four equations, linear, algebraic, in K's, i.e. 


ray 
| 
I 

©) 


Te = ap 9° Ki A -C-SOA One 


ll 
Go 


Poq = By KootBo Kon -C-SOB eS 


= Eee 93D *Ka, > ~G@r5OG -=—G. 7°32 ,5 


ry 

Lo 

b—-4 
| 


4 = By *Ko,tBo "Ky, = -C°SOD =-C - 360.0 


Also from the nonlinear algebraic equations in matrix 


form 


K = 0 = -K-A-Al-K - Q + K-B-R7’-B!-K 


the following ten equations written explicitly are used: 
(F},)° : Cl-E=0 

(Furs Faz) -CI- (Ky 1 4Ky2°4114K14°412) =0 

(Fiq°F31) CL + U - Ky; = 0 
eo 859 897 813 7K 14420) -9 

(Fo1) 2+ CI-2+ (Ky 9tAq1 ‘Ko9tAy9 Kou) -A=0 

(F21°F31) -CL-(K1 3447] *K93tK 34-412) W-K21=0 

C(Fo1° Fay) *CL-(Ry44Aq 1 Ko tKyg Ay otha] 'Ko9+K93tga ‘Ko4) =0 


(F31)%-+CI+2-U-Ky3 - D=0 





(F31°Fay) -CL-(Ag] -K39tK3 3422 -K3q4) tU-K 1 4=0 
(Fy) 7+CI-2+ (Koy+An1tK 34, tKyg°A92)-B =0 
Substituting in the above: 

Fi, = -C*SOA 

= -C-SOB 

F31 = -C-SOC 

Fi, = -C+SOD 


and defining also: 


ey = Ky 
x(2) = Ki9 
x(3) = Ky 3 
x(4) = Kia 
x(5) = Koo 
x(6) = Ko 
m7) = Kou 
x(8) = K 33 
a?) = Koy 
x(10) = Kaa 
x(11) = E (Depth error weighting factor) 


x(12) 


DEG meowmerror weighting factor) 
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x(13) 


x(14) 


A (Depth error rate weighting factor) 


B (Pitch error rate weighting factor) 


A system of 14 linear algebraic equations is formed, from 


which given the specific feedback control gains SOA, SOB, 


SOC, SOD, the steady state constant K values and the 


corresponding values for the weighting factors in Q of an 


equivalent optimal controller can be found. 


written in the matrix form A X = 


mee 0 0 0 0 


1 AA Q 
-U O Q 
O AC l 
24 «(O 


O -U 1 


AB Q 


200 


AD Q 


0 


0 


0 


0 AA 0 


O QO AA 


feo O 1 AC 1 (ASHMD) 0 


foe -20 0 0 O 


mo 0 UO A 


0 QO 0 
O BA Q 
mO 0 
a0 


10 0 O 


O 0 


BB OQ 


0 


0 


0 


BA 


0 


0 >, Ogee 

0 072.0) 20 

0 0 0 0 

0 Co Oras 0 

2AB 0 Q OQ 
0 O AB OQ 

O AB 

0 Oreo 0 

0 1 AD QO 

2AC O 2 24 
0 O1.°70)5 2.0 

BB oF 1G, 

0 O BB OQ 

BA OO O BB 


B 


i: 


0 


0 


0 


0 


0 


0 


0 


0 


The system 


= 


(FBA) 2*C 
FBA*FBB*C 
FBA*FBC*C 
FBA*FBD*C 
(FBB) 2*C 


FBB*FBC*C 





FBB*FBD*C 
(FBC) 7*C 
FBC*FBD*C 
(FBD) 2*C 
-~FBA*C 
-~FBB*C 
-FBC*C 


-FBD*C 


C, the control effort weighting parameter, is considered 
Its value is determined by the designer. 


known in the above. 


ae) 





For the gains in (1) and C=1, solution of the system 
Mer=0.25. b=-9.6686 x 10°, A=-0.1137 x 10°, B=0.233 x 10°. 
The negative values of A and D are not acceptable in the 
optimal analysis. So C was made equal to 0.001 and as a 
result: of the form of equations (right hand side multiplied 
by C), the above values were changed to E=0.00025, D=-6.686, 
A=-0.1137, B=233. Having reduced their values, A and D were 
then neglected and the optimal method tested with values of 
E, B, © around the found ones. 

The values of C=-.001, E=0.001, B=164 were selected for 
subsequent use and results of their use are shown in Fig. 
C-7 and C-8 with the submarine "in trim" and "out of trim," 

The S.S. errors are comparable with that of the feed- 
back controllers and acceptable. 

As for a first indication of the behaviour of the con- 
trollers and submarine under a simple harmonic seaway, the 
Sinusoidal forcing function: 

AU = 2-E-05*sin(t) 
was introduced. Results are presented in Figures C-9 to 
C-12. 

The described method has the disadvantage of the possible 
negative weighting factors that can be found. Variation of 
the value of C can be used to lessen the magnitude of these 


negative values and indicate a region of the positive ones. 


oe 





A good linear model will improve the results and allow 
use of the CE (1) for a systematic search for the "best" 
placement of roots either by parameter plane or root locus 
methods. Using the described method the controller C=10, 


B=800, E=1 was also found, corresponding to a closed loop 


CE S440.978037S-+0 .464618S-+0.106002S+0.493183E-02 and 


roots 
-0.06077 


a 


0.40235 


aD 


$3.4 = -0.25745+}0.36798. 


Results of its use are shown in Figure C-10 with the 
sinusoidal input at AU. This controller, having acceptable 


performance, was also used in the formulation of the CMC. 


B. BOTH PLANES SUBMARINE 

Extension of the method developed in the case of the 
both planes submarine was proved very tedious and of Aoabe 
ful usefulness. 

For this, only a few results will be presented that 
would be useful in similar studies and the intermediate 
steps will be omitted. 

Use of 


DSAD = pee Ena oay WR otY 57° Esty, 7 /U-Ry 


ei 





DBAD = Y 


12° Ey t¥o9/U-E,t¥35-E,t¥,5/U-E, 


mies - Ab + BU, results in the closed loop CE given 


below. 


Peewee lees 21> Y12, “99, Y39, Y4o were defined in 


Ref. (1) and the following substitutions were also made 


for the 


FSA 


FSB 


FSC 


FSD 


Then 
4 


a t+ 5 


general case of feedback controller. 


= eal FBA = Y419 
ey a FBB = Yo9/U 
= 131 | BE Caso 
= ¥,1/U FBD = Y,5/U 


*+ (-A11-By1-FSB-Bo1 -FBB-Ap9-By9-FSD-By9°FBD | 


Ay1°A29+B11°A22:FSB+B91‘A99‘FBB+A11°B 19 °FSD 
2./ +Bo1°B,9°FBB+FSD+A11-B99°*FBD+B11‘Bo9°FSB-FBD 
~Ag1 +Aqo-Ay2°B 1° FSD-A12°B21-FBD-A21°B19°FSB 
-B91‘B19‘FBD:FSB-A91°Bo9‘FBB-B11°B99°FSD-FBB 
-B]1°FSA-B91°FBA-B19°FSC-B99 ‘FBC 


Ayo °B11-FSA+tB99°FBD-+By1-FSA+tA99°B91:FBA 
+B19°FSD-Bo1-FBA-A91°‘By9-FSA-B91-FBD‘B19 ‘FSA 
-An1°Bo9*FBA-B11:°FSD*B99+FBAtA11°B 9°FSC 
+B51°FBB*B19°FSC+A11°B99°FBC+B11-FSB*Bo9°FBC 
~A19°By1°FSC-Bo9*FBB*B11°FSC-Ay9‘Bo1 ‘FBC 
-B19°FSB’°B91‘FBCH-B 9-FSA+-By9°FBA 
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B>9°FBC*B,1°FSA+B,9°FSC:B91°FBA-B71°FBC*B,9°FSA 
-By1°FSC+B99°FBAtU*A}9°B 1° FSA-U-A]1°By9°FSA 
+U+Bo9‘FBB-B11°FSA-U*B91°FBB‘B 9°FSA 
+U+Aj9+B91°FBA-U+A,1-Bo9‘FBA 
+U+B,9°FSB*Bo1°FBA-U-B 1°FSB+Bo9°FBA 


The simplest case will be to accept the relations: 


FBA = FSA 
FBB = FSB 
FBC = FSC 
FBD = FSD 


men the resultant CE will be of the form 


s* + (b1-FSB + dj-FSD + e1)-S? 
+ (ao'FSA + bo‘FSB + Co°FSC + do-FSD + e9)-S* 
pepe ros = bs° FSB + C4-FSC + e3) 
+ (a,°FSA) 
Parameter plane methods will help now in selecting positions 
for root placement and give values for gains. The next in 


difficulty but more interesting case will be to accept 


Geveations of the form 


fo4 





FBA = -K-FSA 

Hee = =-K°FSB 

FBC = -K-FSC 

FBD = -K*FSD 

The characteristic equation can result, by the applica- 
muemeOr some Stability test, into conditions on FSA, FSB, 
FSC, FSD for stable roots in the form of a system of 
inequalities or again parameter plane methods can be used 
to give values of the feedback gains. 

Finally desired values can be given to four of the 
feedback gains and the other four used as parameters. 

To correlate the results with that of optimal control 
analysis on altered form of the DSAD, DBAD equations is 


mseed, 1.e. 
[ 
DSAD 1/C, 0 al Foy Ft Fay 
DBAD 0 1/C5 Fi92 B99 P39 Fy9 
ae OT tet e e ek gy Batty 1° EZ) 


pe Crimea op Hoth 49°Ha th) 5° EZ) | 


Then 


FSA = -1/Cy-Fy1 FBA = -1/Co‘Fy9 


FSB = ay Cron FBB Ceti 
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FSC 


ee nae ort FBC aly Cmte 


FSD = -1/C,‘Fyy FBD = -1/Cy°Fy9 


With linear feedback gains selected for a desired CE 


and using the defining equations of Fy 7B 1 Ky otBi9°Ki> 
Meo) Ki 9tBoo:Ki,, etc. together with the Riccati 


algebraic equations for the steady state solution, a system 
of eighteen linear equations in sixteen unknowns (C1, Co, 
A, B, &, D, Kiz, Ko2, R33, Kag, Riz, Ki3, K23, K14, Kag, 
K3z4) results. 

This requires the introduction of two additional non- 
diagonal weighting factors as unknowns in the Q matrix and 
consequently in the algebraic equations. Solution of this 
system of eighteen linear equations will give the corre- 
sponding optimal control weighting factors, where once 


again the possibility of negative values is not excluded. 
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APPENDIX D 


SIMPLIFIED TRIM ANALYSIS 


As the submarine changes speed, hydrodynamic forces 
and moments change in proportion to velocity squared. 
When the submarine is at a neutral bubble, these changes 
are in equilibrium and is neither necessary to change the 
weight of the submarine nor to shift the center of gravity 

Necessary changes of variable ballast are accomplished 
with the trim system. In this paper three trim tanks are 
used and shown in Fig. IV-4. 

To determine the required ballast at the speed of 
15 knots, (the constant speed of all simulation runs), 
the following approximate method was used. 

The equation of motion along the body axis system 
Z-axis when w, v, p,q, r and their derivatives are set 


equal to zero gives: 


_ | 2-02-22 


b cos © - cos 


where Ww, > QO =>ballast to be added 


W, Va 0 =ballast to be blown 
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For 9 = = 0, Zuu = -0.1x107° (Ref. 3), Ce 415, P/2 x i 


Wp = 17.22 - UA 


This parabola is plotted in Fig. Del. 


For U = 25.33 ft/s W, = 11050 1bf. 


From the equation of motion about the body axis system 


y-axis 


a Pee - Zp Sin e+ 79-02 Mun U2 
Weeos eo 
where 
Xq = X coordinate of the CG 
W =m-g = weight of submarine = 0.625x105x32=2x10/1bf 
B = buoyant force 


Zp = separation of submarines c.b and c.m 


For 9 = 0, Muu = 0.4 x ome (Ret 2) 
y 
z 0 3 Muu-U _ 4p ae 
a = a =—Sia3 x 10 U 


iias curve is plotted in Fig. D-2 


Mem U = 25.33 Ge a Os 


The above calculations suggest addition of 11050 lbs in 
the auxilliary trim tank to compensate for W,. Additional 


ballast has to be added since X, = 0.1 = 0, 
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For FT = -AT 


W°X 


ain Buel 5). 5-215), 5) 


Beeeine W = 2x10’ + 11.05x10° 


Meee 2118 lbf and AT ~ -51138 Ibf. 


If these values were used in the program, they would appear 
as AT=-7.16x1072, FT=7.16x107°, AU=1.546x1074 
The values used were 


AT=-6.4x1079, FT=6.4x1072, AU=8.8x107°. 


APPENDIX E 


imman eftort to find limits on the exponent x in 


eosin) 


3 
fcom 


different computer programs were developed. 

The programs use almost the same approximations but 
different criteria each time lead to different regions 
mevariation of x. 

A short description of each one is given next and 
intermediate steps are omitted where the analysis is 
straightforward. Because of the approximations used it 
was not expected that the results would be much restrictive, 
even sometimes acceptable. Further refinements are possible. 
In all cases the root loci analysis already described in 


Chapter V gave better results. 


1. The first two programs (programs 9 and 10) result from 
an analysis of the response to a step input of the sub- 
marine with the CMC and optimal design in the combined 
controllers. The criterion used was minimization of a 


function of steady state depth and pitch errors. 
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From the designed optimal controllers 


.. 


FSA*X1+FSB*X9+FSC*X3+FSD*X,, rio te order 


5 S9 


*Y. +SOBKX .+S0C#X.+S0D%* ster planes order 
SOA*X,+S0B*X5+S0 X4 SOD yt in SOPOC 


Fairwatez planes order 
im spe Oe 


Oe) 


FBAMAPEBBAK +FOOHK 3 FBDAKG| 
iiast approximation 


Bapstituting in Sf, and solving for t results in: 


- 9 £1-FBB*X)-FBD*X, 
FBA*X5+FBC*X,, 


second approximation 


X, =P * X (P experimentally found between 150-200 
2 4, 
for the given submarine and acceptable 
response) 
Then 


) £1 -(FBB+FBD/P)*X9 
(FBA+FBC/P)*X> 


5 S1= be,% esc | +Xo% f -FSA-FSC/P ) = ( FBBt+FBD/p sespsrs0 | 


FBA+FBC/P FBA+FBC/0 
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8 sy ey* | § OA+S0C/P +X," ‘| -SOA-SOC/P)*(FBB+FBD/P +s0B+s0D/? 


FBA+FBC/P FBA+FBC/( 


Since 


com 5 s7 + K (S sea) then at the steady state 


mech X9 = Q 
= § 2 SOk1S0C/ | FSA+FSC/P-SOA-SOC/P 
scom Cfl 
soa+soc/P | ESATESE LE Soe Socle 


Using the limiting condition 


“0.436 / 3 som L 0.436 


and setting 


u = },,* | ESAHFSC/P-SOA-SOC/P 
malt FBA+FBC/P 


Then for ° and 0.436_ ( 1 
\6 fcom | 


NN ASOA+SOC/ P ~, SOA+SOC /P 
-0.436-9¢1*( (FatFBCT?) 0.436-9£)* ee ) 
log S log 


H \ H 
ioe (02430) log (0.436) 
lOfcom| [Ofcom | 


where ieee = S£1 


BOT HO the signs of the inequality are inversed. 
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In order for the above unequalities to be of some uSe, 


the value of 


From the linear model 


xy 0 1 
Xy | 0 0 
xy, 0 Aj? 





0 


0 


0 


ie 0 Xy 
Aoi | | Xo 

i i Ky 

ha 











¢, to be substituted in, must be specified. 


0 0 
B F 
co met 
0 Oo" 
| | 
Boo Lv 


where F, M are terms due to external step forces and moments. 


and with U = 


KO 6, + (1-K)*8 55 


| K*FSA+(1-K)*SOA ]*X, a 


| K¥FSB+(1-K)*S0B J *X, 2 


| KXFSC+(1-K) *SOC ] #X, 4 


| K*FSD+(1-K)*SoD | *X), 


meeis finally found 


s.s depth error 


ees pitch error 


K*¥R1+R2 


ate, 


aon G 


K*RotRy, 


Ri, Ro, Rg, Ry, Re, Re are given eplleialy an programs 9 


and 10, 
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maewrunction to be minimized is 


(s.s depth error)” (Deseo! p LEC Een ia 


Taking derivatives with respect to K gives K as a solution 


of the quadratic equation 


Z Z 2 2 
x2axe | RTR4ARLRIR3-2P R3R5R6] , (R]RRy- 9 R3RE | _ 


0 (1) 
| a a ean ae 
[RER3-p R3Rs | (| RIR3-PARgRE | 
At steady state 
& fcom % FBA*X1 5. + FBC * A355 (2) 
Meewas also found that 
_ RIK +R —_ReK +R 
Xiss = ath 2 ; X9s5 = eae eo) (3) 
ea 7, Eo anaes ays 


and that the value of K minimizing ee = Cae is 


m@e solution of (1). Substituting this value in (3) and 
using (3) in (2) results in the desired value in the x 
inequalities to give the region On x Verlacion. This 
Beton is expected to be reduced if the values +0.436 in 
the limiting condition are lowered depending on the magni- 
tude of the applied moments and forces. Also, it is 
possible instead of using in the above the value of K 


minimizing the function of depth and pitch errors, to use 


ies 





a second order approximating system and express the steady 
state errors as functions of specified < Gromeexample (= 
0.4-0.6), settling time (for example 120 sec) and input 


forces (for example 70 tons). These values of X1,,5, X36¢ 


will subsequently give the value of Sites to be used in 


the x inequalities. 


2. The application of step inputs to the system leads to 
the saturation of the forward planes and a different from 
zero angle of the stem planes, before the CMC is energized. 
For a more elaborate analysis the effect of the above 
must be considered. This is done in programs 11 to 13. 
In program ll the effect of saturated forward planes is 
translated to initial depth and pitch errors. 
Programs 12 and 13 are almost the same as 9 and 10 but 


properly modified to accept results of program 1l. 


3. The next approach was to put limits on the exponent 
of K considering the response of the system to impulse 
inputs. 

The starting point was to consider a second order 
approximating system, find the closed loop CE with 


U=K § 51+(1-K) 3 o> , accept a value of ¢ and use the form 
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s*+42T w StH, * and the relations between the power coeffi- 
cients to get a corresponding value of K suitable for use 
with the inequalities from the step response. (Programs 
9-13) 

In program 14 the found CE of the form S2+A(K)S+B(K) 
is set equal to $2420 ww? and a relation derived which 
gives values of K with ¢ as a parameter. 

Finally in program 15 further approximations are made 
to result in an expression giving K with parameters P(150-250) , 
i , and X5 (average value +08 depending on side of response) 
and a the independent variable . Using this program, 
the CMC with separate optimal controllers having weighting 
factors B=800, C=10, E=1, also “( = 0.6-0.8, P=220-250 
and X5 = -0.2, values of K varying as function of S £com 


were found. The results are shown in Fig. E-1 to 6 where 


also (0.436, * 
Ofcom is plotted for different values of x. 


In these figures the region of comparison is for fete 
between 0.74 and 0.9. The curve with X=1.2 is the one 


that better approximates the K-curve found by the program. 
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4. Additional informations for the use of the programs. 
a. When forces or moments are desired to be introduced 
in the right side of the linear model state equations, the 


3 


quantities already divided by either L™ or te have then 


to be multiplied by the matrix 


XMA XMC Ona 2 a ome el 


XMB XMD =e ei Hes... 07 


For example application of the step -2,208x1072 at the FT 


mesults in the terms 


Seo -5288.51 Se eee FRC 


a3 zm 
FOO0S 1 1035.02 : -2.208x10 ~+Xpr TRQ 
4152 


le 
SCA, S5CB, SCC, SCD are the same as FSA, FSB, FSC, FSD 
BCA, BSB, BCC, BCD are the same as FBA, FBB, FBC, FBD 
A 


A Ago are the same as AA, AC, AB, AD 


Aiy> 401° Ayo» 


hrs ©91;> 819, Bo9 are the same as BA, BC, BB, BD 
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APES NDIxX 


EQUATIONS OF MOTION 





The followinz set of equattons are referred to a body 
fixed system of axes which are coincidene with the prin- 
Supa axes of “Snertia of the body. The ortgin of this 
axis-system {ts located at the assumed center of mass of 
the bodv 


Equation of Motion Along the Body Axis System x-Axis 


m(u - vr + wq)= 5 Ea tg? + St Me ‘rp | 


- 5 = eee eee ‘wa | 


+ $2? [ x cries e Xeae Urw 

: Fit x §rér » 8, ees ‘, > eat 6,7 
+ <a eee Tint she: 

bBarx tint 1) wt 

: 5 at < §s6sn! » fat = 1) 6? 

+ £47? x Re (n= 1) 6? 


~ LW sin 9 


an (Fp 


Gs 





Equation of Motion Along the Body Axis System y-Axis 


m(¥ - wp + ur) = 34° PGs ee 


+ 24s eons Pat Y ora ‘lel | 


+e ly. 'Y + ee we + Yytetety [vt + wi)? | Il] 
+2e° ee ‘urt Yi g hulrlor+ ¥ ‘up | 

+£4° ee (n= l)ur 

+P y fe tur + vy ‘uv + Ei Hl (vt + w2)2]] 
tPgruty 6. 


Se ye 2 ' tot 
+5 £°u ent (n 1) 6. 


P ,2 ' a 
+ 5 be ot en (n 1) uv 
2 2 2,2 
+$4 eerste, =) vi{(v? + wy? | 
Stee a camel 
2 wv 
areola av? awe (-w) Sin wt # Multiplicd by 
y —j— — 
; for large angles of 
+ OW, sind cos 8 attack near -90° 
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Equation of Motion Along the Body Axis System z-Axtis 


Note l 


ty ¢ 1 
[Zz Ma oes eterno vp + OZ, ' vp] 


0 ' * 
oer [zg 'uq + Z oe sare Sev + 0A al 


lq] se q| [w 


+ $e Z ont ‘(al I) uq 


+ 22? ie lace eee ore | Hw]? + we?) ] 


: ul w| + Z 
ww 


4 A t 
2 jw (v2 w)PP es Zt vee | 


‘D2.2 i ' ] 
+ $1 Zam bs +Z.. ' bb 


. 54? [z es hadn't - lbuw + Z ww at atives 1.) w| (v? + we | 


9 2 
ae as Lot 


= '(nt- 1) 6, 


+ $4? ele ve + Ww? v Sin wt 
ie 
+ EW. cosGcosP + # Multiplied by ~ 
2 
U 


for large angles of 
attack near -90° 


. Note | 
when not multiplied by 
Unaad toc | 
UD me 





Equation of Motfon About the Body Axis System x-Axts 


e . O ,6 oe ; t : 'r+K 
Pome eee at = [K Eee arr de rps Ney | ‘ple! | 


4 1 t ao tw ' 
+ 21 [K | up + KL urtK. vtkK wp | 


+24? [K, erent pe ee 'v|(v? +w? 2] 


0 ,3 t 
i ee vw 
P ,2 ,,2 ( 
+ 5 u'K ,. 6. 
ein d cos 8 


+ Bz 
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Equation of Motion About the Body Axis System y-Axis 


Note 1 
i: t 2¢ t ' 
[M 3 qo ee Seep rpé| 


nto 
hs 
or 


ra + (1 - [) Ip = 


+ 1" [M 'ua+M 1 oig, 'ulqlés + M ie tiivig watt a] 


~ 
o 


[M Sean et eee ' vp# | 


LT t(n! - 

+ 54 eat (n 1) uq 

Tats [ M tut Mo tuwtM twl(v¢ ey] 
2 se Ww wil wl x 


| t * i 
+£,° or ulwl| + M. | w (v? + wa) t+ M ve | 


Ww 


3 2 t t 
+24 u [mM ., 6, +My, | 


D ,3 

+ 54 M on! '(n' = 1) uw 

‘ §e a wiwn' eee caet wy? | 
LP 2 

tshou M gent '(n' - 1) a 


# Multiply by 5 for 
large angles of attack 
near -90 


Note | 
when not multiplied 
by Yaddto M_§' 
U -)2 


+ Bz , siné@ 


- EW, x. cos 8cos P ‘ 
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Equation of Motion About the Body Axis System z-Axis 


e ene 5 e e 
eet -tpa = 54 [N, t+ N teat, te] 
+ $4" | N "ur + en OES Sain Cy + wy Flr] 


+ $e aoe itor lice 


+ $s N eo ( Omar) ), ay 


+ oe eran: '(n' - 1) vl (v2 + w? 2 | 


+24 N ' wv 
Vv 


r : ; ud 
+ LW. coo 2 6 sin? f Multiply by — for large 
angles of attack near -90° 
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AUXILIARY EQUATIONS 


p+ d sin® 
(q - Wcos@ sind )/ cos 
(r + eno) / cos cos 


ucos9cos) +v (sin® sin9@ cos - cos sin?) 


+w (sind sinw + cos) sin@ cos) 


ucos@ sin? +v(cosQOcosp + sin® sin@ sind) 


+ w (cos sin@ sind - sin® cos) 


-u sin9 +vcos@ sing +wcos@cosQ 


(u? + v2 + ene 


t t 2 
Gaul ay tag'at + as e ] when k, <n! 
= Btu? [oy + dyin! + byt al? | when k < a'< ky 
= 2 Pel ot icant + é,' nt? | when k, < a'< ky 


= Batu?[ at tdytnt t dyin! | when ni < ky 


Bd» 23 
Dey b; Sets of non-dimensional coefficients "sed in the pro- 
ones 
pulsion equation above. ‘The set wnieclh will be> in Se 
C5, C3 ateany tine curing 4 similated maneuver will depend on tne 
value of n. and the numbers k,,%5,k4- 
‘ ' Bale oasr 
do, a 
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NOMENCLATURE 


¢@ 


All symbols used tn the equations of mocion and in che 
auxiliary ecuations and relationships which appear tn chis 
report are defined below. Any dimensions tnvolved will be 

_consistent with the foot-potnd-second system of units. All 
angles are in degrees. The Fortran variables corresponding 


to these symbols are shown in Appendix 8 . 
SYMBOL : DEFINITION 
° A dot over any symbol signi- 
fies differentiation with res- 


pect to time. 


B Buoyancy force which {fs posi- 


tive upwards. 


m Mass of the submarine tineluding 


the water in the free flooding 


spaces. 
54 Overall length of the submarine 
U binear velocity of origin of 


DGCy axes ene tative Co an earth= 


fixed axis systen. 


u Component of U along the body 
x-axis. 
Vv Component of U along the body 
y-axis. 
9 
Ww Component of U along the body 
z-axis. 


ele 





Ve 


1d 


Command speed: A steady value 
of u for a given propeller rpm 
whena, B and control surface 

angles are zero. Sign changes 


with propeller reversal. 


Longitudinal axis of the body 


fixed coordinate axis system. 


Transverse axis of the body 


fixed coordinate axis system. 


Vertical axis of the body fixed 
coordinate axis system. 


Distance along the x. axis of an 


Q 
earth-fixed axis systen. 


Distance along the - axis of an 


earth-fixed axis systen. 


Distance along the z, axts of an 


earth-fixed axis systen. 


Component of angular velocity 


about the body fixed x-axis. 


Component of angular velocity 


abouc the body fixed y-axts. 


Component of angular velocity 


about the body fixed z-axis. 


The z coordinate of che center 
of buoyance (CB) of the subma- 


rine. 





ab, De 


or, Dr 


és , Ds 


m Q& 1 ©® 


x 
- 


t2 


Angle al attack, 
Angle of drift. 


Deflection of Now tant Cror 


saitlplane ) 

Deflection of rudder. 
Deflection of sternplane. 

Die erat fo ui/u. 

Pitch angle. 

Yaw angle. 

Roll angle. 

Mass density of sea water. 
Wefphte of water blown from a 
particular ballast tank ident- 
ified by the integer assigned 
COmCnen index 1. 

Angular velocity. 


aime: 


Location along the body x-axis 


of the center of mass of the ich 


balfast tank when this tank is 


filled with sea water. 





Mot) OM 

Hivle? 
mM to OM 
wd 


Cre) 


‘ t 
K: / t 
pe Sp» Koto] Kare 
é af ee = ‘ 
ers Ke Ky Rup? 


t ; » t ; AM t 
Er tp tp 
He 2 Mee.”, : 
w a vp 
M M 
Siw je; owe 
ae Mofwint : 
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Moet ’ 
| iq|és 
M $ M : $ 
qn 
t 
: see ; oe 
8 
aan 


Peopuigton force (see auxi-= 


liary equations and relation- 


ships). 


Moment 


marine 


Moment 


marine 


Moment 


marine 


of tnaertta of a sub- 


about the x-axis. 


of tnerttia of a sub- 


about the y-axis. 


of inertia of a subd- 


about the z-axis. 


Non-dimenstionaul constants each 


GOemwliten 1s assigned to a’parti- 


Cwlar force term in the equation 


Or Motion about the body x-axis. 


Non-dimensional constants each 


Gfewnien ts assigned £o.a parti-= 


Cular €Cocce term in the equacicn 


of motion abouc the body y~axis. 





Non-dimenstonal constants each 


' ' ¢ ? % 
Nel iewior? a 4g a : of which {s assigned to a parti- 
cular force term {n the equation 
N : N : q aes N mG N { 3 
viv[ ° "Sc ° “rn vn vivin of motion about the body z-axis. 
: 
By 
' q ¢ 9 q 9 
qq $ ee $ rp $ Xs > ave 9 wq $ 
‘ ) ‘ i 5 Non-dimenslonal constants each 
eau : ae . re : aire * "6s68 ° 
of which its assigned to a parti- 
’ ’ ’ ’ GUular torce term in the equaettion 
abs b , Sor : Cone seeorso sn : 
of motion along the body x-axis. 
q 
eS rs ca’ 
py : Wass! Y ee a - Vole! Y ? 
mo Pp ° Pa el 4 > wp 
Y ’ 1» Non-dimengional constants each 
vir]! ic : Yr elér : YS > Vint? 
of which fs assigned to a paret: 
' ' ' ' ; Gular skonreeuterm in €he equatlioa 
Ye *y : Elec : ee : Bien : 


of motion along the body y-axis 


Non-dimenstonal constants each 
of which ts assigned to a parti- 
Cwlar itoree term in ‘the equatio- 


rs ora) of motion along the body z-axis 
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Mm ws Ww YP 


Bel C2 


Seee ll ,Cie2 


CE 
SOPOC 
SOPC 
BPOC 
CMC 


FSA, FSB, FSC, FSD 
SCA,SCB,SCC,SCD 


mon, FBB,FBC,FBD 
BCA, BCB,BCC ,BCD 


een, 208,500 ,S0D 
feb, FC, FD 


EOM 


Poe 2 Ponenuemavkeix Of the state vector 
COcmlcloay Matrix Of the input vector 
State vector 

igo Gave c TO 

elit s vec Lor 

Control effort weighting matrix 
Control effort weighting parameters 


Control effort inverse weighting parame- 
ters 


Weighting matrix in quadratic performance 
index 


Depth rate weighting factor 
Pitch rate weighting factor 
PinCcCrwMerirolm Welehting factor 
Depth error weighting factor 


By ae ae 


Longitudinal CG of the submarine 
Characteristic equation 

stern only planes optimal controller 
stern only planes controller 
Pouolates Opcimal controller 


Combined mode controller 


Feedback gains in 
Feedback gains in 


Feedback gains in 


Iho fs O2e ehmaleyal 





Stern plane command in both planes submarine 


Fairwater plane command in both planes sub- 
marine 


Stern plane command in stern plane only sub- 
marine 


1966 
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Fig. I-1. Coordinates of waves 
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Fig. IV-llc. Stern Plane Angle vs. Time. Response to a 
step force at AU. CMC uses optimal design 
in combined controllers with B=800, cC=l10, 
E=l1. Parameter X=1.0 
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EF=l. Parameter X=0.9 
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E=l. Parameter X=0.5 
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Fig. IV-23b. Pitch vs. Time. Resoonse to a step force 
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Parameter X=0.05 
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Parameter X=0.9 
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CMC uses optimal design in combined controllers 
with B=164, C=0.001, C=0.001. Parameter X=0.5 
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Fig. IV-40a. Depth vs. Time. Response to a pulse force at 
PY. CMC uses optimal design in combined con- 
waoilers, with B=164, C=0.001, E=0.001. 
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stern Plane Angle vs. Time. Stern planes only 
Submarine, "in trim" with feedback controller 
(SOA=-0.5, SOB=-7.03, SOC=32.5, SOD=360) and 
zero pitch and depth ordered. 
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Fig. C-5b. Pitch vs. Time. Stern planes only submarine, 
"imecrim. with feedback controller 
(SOA=-0.0436, SOB=-3.49, SOC=0.0523, 

SOD=360) and zero pitch and depth ordered. 
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Stern Plane Angle vs. Time. Stern planes only 
submarine, “in trim" with feedback controller 
(SOA=-0.0436, SOB=-3.49, SOC=0.0523, 

SOD=360) and zero pitch and depth ordered. 
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Fig. C-6a. Depth vs. Time. Stern planes only submarine, 
VinMeccine wlth feedback controller 
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Fig. C-8a. Depth vs. Time. Stern planes only submarine, 
"in trim" with SOPOC (B=164, C=0.001, E=0.001) 
and zero pitch and depth ordered. 
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pitch and depth ordered. 
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Fig. C-9c. Pitch vs. Time. Response to sinusoidal force 
at AU. Stern planes only submarine, "in trim" 
with SOPOC (B=164, C=0.001, E=0.001) and zero 
Deuecheana depth ordered. 
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Fig. C-l0a. Depth vs. Time. Response to sinusoidal force 
at AU. Stern planes only submarine, "in trim" 
with feedback controller (SOA=-0.5, SOB=-7.03, 
See-s2e5, SOD=360) and zero pitch and depth 
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Fig. C-l0b. Pitch vs. Time. Response to sinusoidal force- 
at AU. Stern planes only submarine, “in trim" 
with feedback controller (SOA=-0.5, SOB=-7.03, 
SOC=32.5, SOD=360) and zero pitch and depth 
ordered. 
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Depth vs. Time. Response to sinusoidal force at 
AU. Stern planes only submarine, "in trim" 

with feedback controller (SOA=-0.0436, SOB=-3.49, 
SOC=0.0523, SOD=360) and zero pitch and depth 
ordered. 
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Fig. C-llb. Pitch vs. Time. Response to sinusoidal force 


at AU. Stern planes only submarine, “in trim" 
with feedback controller (SOA=-0.0436, 
SOB=-3.49, SOC=0.0523, SOD=360) and zero pitch 
and depth ordered. 
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Fig. C-llc. Stern Plane Angle vs. Time. Response to 
Sinusoidal force at AU. Stern planes only sub- 
marine; “in trim" with feedback controller 
(SOA=-0.0436, SOB=-3.49, SOC=0.0523, 

SOD=360) and zero pitch and depth ordered. 
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Fig. C-l2a. Depth vs. Time. Response to sinusoidal force at 
AU. Stern planes only submarine, "in trim" 
with feedback controller (SOA=-0.0656, 
SOB=-1.47, SOC=26.2, SOD=184.1) and zero pitch 
and depth ordered. 


DAA 








$ 


" ’ 
; 
vol haa H aN 


aA p a a 
a ae aa. QS 25aeG pean. ape a 
. —_ dl 


ASCALE =3C 
YSCALES 5 
ig. C-12b 


tr yee 


}.00 (9) UNTTS-INCH 
52 OQE-she4UN ITS -TNSH 


Pitch vs. Time. Response to sinusoidal force at 
AU. Stern planes only submarine, "in trim" 

with feedback controller (SOA=-0.0656, 
SOB=-1.47, SOC=26.2, SOD=184.1) and zero pitch 
and depth ordered. 
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Pitch vs. Time. Response to sinusoidal input at 
AU. Stern planes only submarine, "in trim" 

with SOPOC (B=800, C=10, E=1) and zero pitch 
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